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序 完 。 


四 元 数 的 基本 概念 , 早 在 1843 年 B.P. 哈 密 顿 就 提出 来 了 。 
但 一 直 停 留 在 理论 概念 的 探讨 阶段 ， 没 有 得 到 广泛 的 实际 应 
用 。 近 年 来 ， 由 于 航天 技术 的 发 展 ， 需 要 解决 大 姿态 角 的 控制 
问题 。 传 统 的 欧 拉 角 法 ， 由 于 在 大 姿态 角 和 情况 下 ， 欧 拉 方 程 是 
”奇异 的 ， 给 解 大 姿态 角 带 来 了 困难 。 因 而 ， 四 元 数 法 日 益 受 到 
重视 。 由 于 四 元 数 方程 是 线性 的 ， 只 有 一 个 联系 方程 ， 在 解 算 
大 姿态 角 时 ， 带 来 很 大 方便 ， 特 别 是 可 以 直接 用 四 元 数 分 量 作 
为 控制 信号 ， 使 四 元 数 法 的 应 用 ， 得 到 很 大 的 发 展 。 

70 年 代 以 来 ， 数 字 计 算 机 和 计算 技术 的 发 展 ， 有 可 能 进行 
误差 信号 的 合理 选择 和 控制 ， 四 元 数 作为 最 理想 的 控制 参数 ， 
被 广泛 采用 ， 诸 如 导弹 制导 、 载 人 飞船 和 航天 飞机 中 的 很 多 姿 
“” 态 控制 任务 中 ， 都 引用 了 四 元 数 法 。 

四 元 数 具有 很 强 的 物理 意义 ， 它 可 以 表征 刚体 姿态 变换 时 
的 瞬时 欧 拉 轴 和 所 需 的 转角 ， 作 为 一 种 姿态 控制 方法 ， 是 既 十 
老 而 又 年 青 的 ， 在 实际 应 用 中 ， 还 有 很 多 理论 和 实际 问题 需要 
解决 。 

本 书 前 两 章 是 基本 理论 部 分 ， 叙述 四 元 数 的 基本 理论 及 其 
计算 方法 。 后 两 章 是 应 用 部 分 ， 首 先 研 究 了 在 刚体 姿态 控制 中 
利用 四 元 数 作为 误差 信号 的 控制 稳定 性 问题 ， 并 分 别 对 姿态 控 
制 中 的 定向 问题 和 定位 问题 进行 了 研究 。 然 后 ， 利 用 最 优 控制 
理论 研究 了 四 元 数 的 最 优 控制 问题 。 给 出 了 飞行 器 姿态 控制 喷 
嘴 的 开关 控制 规律 ， 并 结合 航天 飞行 器 姿态 控制 典型 情况 进行 


了 研究 。 

本 书 引用 了 近年 来 有 关 四 元 数 法 的 最 新 成 果 ， 可 作为 研究 
生 教材 和 科研 参考 书 。 

研究 生 李 华 演 同 志 认 真 细致 地 校 阅 了 全 书 ， 在 此 表示 感 


程 国 来 
一 九 九 一 年 十 月 
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第 一 章 ”四 元 数 定义 及 其 基本 性 质 


$1 引言 


在 研究 航天 飞行 器 的 姿态 控制 问题 时 ， 经 常 遇 到 坐标 变换 
运算 。 传 统 的 解 坐标 变换 的 方法 是 三 参数 法 、 六 参数 和 九 参 数 
法 。 | 
三 参数 法 是 解 两 坐标 系 中 的 三 个 欧 拉 角 。 以 体 坐标 系 

0719121 对 惯性 坐标 系 oxoYo%zo 的 变换 为 例 ， 如 图 1.1， 其 转换 


3 





图 1.1 体 坐 标 系 与 惯性 坐标 系 关系 图 
次 序 为 


9 才 幼 Ld td 
000 go z0 ~— PO 220 一 一 >0718 5 一 一 >0718121 


2 


这 里 9 为 俯仰 角 ; 

为 偏 航 角 # 

?为 滚动 角 。 
如 果 以 Xo、VYo、20; Wi 、2:、21 分 别 表示 各 轴 商 单位 矢量 ， 
则 


1 0 cos% 0 -sing 
"| 0 cosy siny || 0 1 0 

0 -siny cosy llsinpy 0 cosy 
| cosp sinp 0 Xol 


一 Sinm cosmD 0 [Igo 


0 0 1 lLlzo 
cosgpcosy sinpcosy ~sing 01. 
cospsinysiny sinpsinygsiny cosysiny 
=|— singcosy 二 coOspcosy Yo 
1 

cospsingpcosy sinpsingcosy cospcosy | 

十 SinpSsiny》 — cospsiny -go” 

bu bs bis||l wo 


bo Da O23 | Yo | (1.1) 
pal ps basllZo 
即 r=Bro (1.2) 

为 了 解 出 欧 拉 角 9、 p、 )， 需 建 立 欧 拉 角速度 方程 。 

设 @ ;是 体 坐 标 系 oz19121 相 对 于 惯性 坐标 系 0zogo 2o 的 旋 . 
转角 速度 ， 它 在 体 坐 标 系 og 19g1z1 三 轴 上 的 分 量 为 ze ooi、 
所 zy 则 

on Oy Oz = P+ 人 +7 (1.3) 
由 图 1.1 知 


四 一 多 5 一 多 cosg3 — psings, 
= - Psings, + peospsinys, + peospcosyz, 





$=#5, =peosys, — $sinys, (1.4) 
y=pa 
故 得 欧 拉 角 速度 方程 如 下 : 
-LP oawisiny 十 OzicoSs] 
,dt cosy 
| 
， 5 一 ovicosy — WrSiny ' (1.5) 


\ 2 =@za + (ysiny + zcosy)tgy 


此 方程 组 为 非 线性 变 系数 微分 方程 组 ， 如 果 知道 瞬间 角 速度 
am、om oa， 则 在 给 定 的 起 始 条 件 下 ， 解 方程 组 ， 即 可 求 
出 9 (为 、%(9 、y(t)。 但 存在 如 下 两 个 问题 。 

(1) 方程 组 (1.5) 为 非 线性 变 系数 微分 方程， 只 能 用 数值 
积分 法 求解 ， 计 算 工作 量 大 。 

(2) 在 大 姿态 角 情 况 下 ， 例 如 %-~z/2， 会 引起 较 大 的 计 
算 误差 ， 且 当 y=z/2 时 ， 方 程 是 奇异 的 。 

故 往往 要 另 寻 其 他 解法 ， 六 参数 法 、 九 参数 法 和 四 元 数 法 
即 是 解 姿态 变化 的 其 他 几 种 方法 。 

六 参数 法 和 九 参数 法 是 解 坐标 变换 的 方向 余弦 ， 由 (1.2) 


式 
r=Br, 
| i=Oxr= Br, (1.6) 
OXxr] = QF),= QBr, (1.7) 


0 ， 一 Oozu yi 
-| Oz) 0 ， -| 可 (1.8) 
~ Wy, Oz1, 0 | . 
故 B= 0B (1.9) 
如 bu = ybal 一 Ozipai 
[oe (1.10) 
bis= ybss — ozipas 


bz = wzb11 一 azipai 
[ee ~ zib22 (1.11) 
bas = sb1s — wribzss | 
[02 一 yb11 
bss = 2b22 ~ ysbiz (1.12) 
(i 062, — Wyi013 
由 于 了 为 正 交 变 换 阵 ， 故 需 满足 以 下 六 个 约束 条 件 
/21 十 23 二 0523 一 1 
b2 1 让 bp2, 十 0 一 
b31+b3, +b?s—1 
biib21 + bi2b22 + bisbzs= 0 
biibsi + biaba2 + b1sb3s—=0 
Dal0al + D2a2bsz + basbas =0 : 
九 参数 法 即 是 在 约束 条件 (1.13) 下 ， 解 方程 组 (1.10) ，(1.11) 
和 (1.12)。 而 六 参数 法 ， 则 是 在 (1.13) 约 束 下 ， 解 六 个 变量 的 
微分 方程 。 可 以 看 出 无 论 是 九 参数 法 还 是 六 参数 法 ， 由 于 要 满 
是 六 个 非 线性 约束 方程 ， 计 算 起 来 是 十 分 不 方便 的 。 
下 面 介绍 的 四 元 数 法 ， 则 具有 如 下 的 优点 ， 
(1) 四 元 数 方程 是 线性 微分 方程 ， 只 有 一 个 约束 条 件 ， 便 
于 计算 ， 与 欧 拉 角速度 方程 比 ， 其 计算 量 仅 为 欧 拉 方程 的 35% 
左右 。 


(1.13) 





(2) 在 进行 模拟 和 数字 计算 时 ， 精 度 高 于 欧 接 方程， 且 不 
会 出 现 奇 异 现象 。 

(3) 可 直接 用 四 元 数 作 为 捷 连 系统 的 控制 量 ， 便 于 系统 分 
析 和 衬 论 ， 优 于 欧 拉 角 。 

早 在 1843 年 ， 哈 密 顿 (Hamilton B.P.) 就 建立 了 四 元 数 代 
数学 .但 一 直 没 有 得 到 任何 实际 的 应 用 。 近 年 来 ， 随 着 计算 技术 
的 发 展 ， 四 元 数 法 在 飞行 器 控制 系统 中 得 到 日 益 广泛 的 应 用 ， 
我 国 已 故 数学 家 关 泌 直 同 志 就 曾 研究 过 用 四 元 数 法 解 飞 行 器 的 
姿态 问题 。 实 践 证 明 ， 四 元 数 法 在 建立 捷 连 式 惯性 系统 、 刚 体 
姿态 控制 、 定 位 和 稳定 的 控制 中 都 得 到 广泛 的 应 用 ， 并 显示 出 
其 优越 性 。 


$ 2 ”四 元 数 代数 学 

四 元 数 是 由 于 要 将 三 维 矢量 代数 运算 推广 到 乘法 和 除法 运 
算 的 必要 性 而 产生 的 。 

四 元 数 是 由 一 个 实数 单位 和 三 个 虚数 单位 i, j,k 组 成 的 ， 
通常 写成 

二 40 :1 十 i 十 Noj+ Nsk . (1.14) 

起 中 4、 入 1、4s、 ?4 沟 为 实数 ，i、j、 上 服从 以 下 运算 规律 ， 
如 图 1.2， 顺 时 针 相 乘 为 正 ， 逆 时 针 为 负 ， 即 

ij 寺 kK 二 一半 

洲 =i== - kj 


(1.15) 1 
Ki 一 j 一 -让 / AN 
i2 二 jj? 二 k? 一 一 1 k j 
可 以 看 出 ， 如 果 加 二 4 二 hs 二 0， 
则 四 元 数 退化 为 实数 ， 如 果 ?2 王 、_/ 
3 二 0， 则 四 元 数 退化 为 复数 ， 所 图 1.2 乘法 顺序 图 
以 称 四 元 数 为 超 复数 。 


如 果 把 i、j、k 理解 为 三 维 空间 的 互相 正 交 的 三 个 单位 笑 
量 ， 则 可 将 四 元 数 看 成 是 由 标量 部 分 (通常 以 符号 sqal 或 scal 表 
之 ) 和 矢量 部 分 (通常 以 vect 表 之 ) 组 成 。 


和 4 二 0 十 入 (1.16) 
入 = hi haji+ Nak (1.17) 

有 时 也 可 用 一 个 四 维 矢量 来 表示 四 元 数 。 
A=(ho, hi, Ns, Hs)T (1.18) 


下 面 我 们 将 证 明 四 元 数组 成 四 元 数 域 (或 超 复 法 域 ) 。 
域 的 定义 ， 在 非 空 集 合 8 上 ;定义 两 种 运算 (加 法 和 乘 
法 ) 。 适 合 
(1) 加 法 适合 交换 律 、 结 合 律 。 
(2) 乘法 适合 结合 律 、 分 配 律 。 
(3) 有 具有 单元 、 零 元 和 逆 元 。 


则 形成 域 (Field) 。 
现在 来 研究 四 元 数 。 
(1) 加 法 
任 取 两 四 元 数 
{2 - (1.19) 
p= po + piit pai pak . 
则 g++p=(g0 +po) (d+ Pit (gs + pe)it (qa + pa)k 
(1.20) 


可 以 看 出 任意 两 四 元 数 相 加 仍 为 四 元 数 ， 且 可 以 证 明 四 元 数 加 ; 
法 满足 交换 律 和 结合 律 。 
(2) 乘法 
gp= (go 十 gai 十 gj 二 gsk)(2o + piit poi psk) 
= [gopo ~ (gi1p1 + g2 pa + qsps)] 
+ [gqipo + gop1 + (gq2 ps — Yap)]i 
+ [gz po + gops + (qsp1— p193)1i 


7 
十 [gs2o 十 &o2s 十 (212s -ga21)]K. (1.21) 
故 四 元 数 乘 四 元 数 仍 为 四 元 数 ， 四 元 数 乘法 以 符号 “* ” 表 之 。 
为 了 运算 方便 ， 四 元 数 乘法 可 以 有 以 下 两 种 表示 式 : 
1) 借用 矢量 运算 符号 的 表示 法 
设 g=go gq=go qit+ gjt+ gsk 
2 一 2o TP=po + pit pjt+ pak 
则 qxp= [go po ~ (gi1p1+ gq2 pe + qsps)] 
+ (gi+ gi qak)po 
+ go (pst pajt psk) 
十 [(ga ps — qs3p2)i+ (gsp1 一 01293)j 
+ (gips ~ q2 Pp1)K] 
一 go2o ~ (292) 二 92o + gp+(gxp) 


(1.22) 
故 2x9 一 2o0o — (PG) + pao 十 200 二 (2XxG) 
由 于 (gxp)=- (pxq(pxg) 
故 ppg 


即 四 元 数 乘法 不 适合 交换 律 ， 但 可 以 证 明 它 满足 结合 律 和 分 配 
律 。 
2) ”矩阵 形式 的 表示 法 
将 四 元 数 写成 四 维 矢量 形式 
gq= (go, 1, ga ,93)” 
P= (po, pi, pa, Pa)” 
则 
go; ~ ~ -9alfpo, 
di» go; -G3 gl|ip 
g*p 二 
qz， qs, gq, -giliyp, 
da， 一 go， 01， dos -2s 


FA 

Gopo dip: 一 2， 一 03s2a 1 

gipo +gop: 一 0222 十 ga2s (1.23) 
dspo 十 Is21 十 go2s | 

gspo dp 十 qi22 十 Yops : 

Do, ~PD1, ~ Pb2, ~ pastlgo 


一 pi po, 2?a，-2xl191 (1.24) 
D2 TPs, 0， Pillgs 
a lps pa, -pi Pollgs 
我 们 把 矩 


~ 


do. 一 0a gq2 
V(g)=| gs qo -gl. (1.25) 
-gs2 dx go 
称 为 核 和 矩阵， 由 (1.23) 和 (1.24) 式 可 以 看 出 在 用 和 抢 阵 形式 进行 
乘法 和 运算 时 ， 如 果 和 欲 将 四 元 数 次 序 颠 倒 ， 则 需 将 核 矩 阵 转 置 。 
(3) 单元 、 零 元 和 负 四 元 数 


四 元 数 单元 为 I=1+0i+0j+Ok (1.26) 
四 元 数 零 元 为 0=0+0i+0j+0k (1.27) 
四 元 数 负 元 为 ” -9= -go -gi- gsi~ gak 
(1.28) 
(4) 道 元 
四 元 数 逆 元 以 9 :表示 之 
1 





-1 | 
4 go + qit gjt gsk 


一 go di- gj— gak 
(qo 十 9ii 十 gaj 十 gsK)(qo — gq1i~ 92i— gak) 





-go 一 gai- gj- qk, gq* 1 3 
qi+gi+gqi+gqgs NN?(g) (1.29) 


式 中 q*=go 一 qi 一 gj 一 人 sk (1.30) 





称 为 四 元 数 4 的 共 轿 四 元 数 。 
人 (9)=MVU +gi+ 各 十 如 称 为 四 元 数 的 范 数 。 
车 N(g) = 二 1， 则 
gq! =g* (1.31) 
即 逆 元 素 等 于 它 的 共 声 元 素 。 四 元 数 g 是 正规 的 。 
(5) 除法 ， 是 唯一 的 ， 由 于 乘法 是 不 可 交换 的 ， 改 除 法 分 
左 除 和 右 除 。 
例如 9、2、z 为 三 个 四 元 数 
xz 一 2 则 z=g-ixp 
VxXO 一 2 则 z=pxg-! 
因 “9%:*pspxg1， 帮 两 z 不 相等 9 
由 以 上 氢 述 可 知 四 元 数 全 体 ， 组 成 四 元 孝 域 ， 或 称 超 复数 
域 ， 它 包含 了 复数 域 和 实数 域 。 
根据 四 元 数 的 定义 ， 四 元 数 具有 如 下 性 质 : 
(1) 四 元 数 之 和 的 共 轿 四 元 数 等 于 共 轿 四 元 数 之 和 。 
(g++ p+ A gt pA* (1.32) 


(2) 四 元 数 之 积 的 共 应 四 元 数 等 于 其 共 轿 四 元 数 以 相反 磊 
序 相 乘 之 积 
(gupsh)*= 人 eg 
(TE 办 荐 党 思 半 -1 闪闪 放 基 关 思 玫 





(1.33) 
《3) 诸 四 元 数 之 逆 ， 由 下 式 给 出 
， (hi Na. so )* 
* 六 1 二 抽 
(2 :xs ss 向) 7 
= AnlxAili NElAI! 
(1.34). 


(4) 四 元 数 之 积 的 范 数 等 于 其 园子 范 数 之 积 


了 0 
上 和 1 入 2 和 二 和 和 (1.35) 


(5) 仅 在 因子 中 的 一 个 等 于 零 时 ， 两 四 元 数 之 积 才 等 于 
例如 gx7 一 0， 则 lgxpj=0,， lglxlpl==0 
因 |1gl，1z1 为 标量 ， 故 或 者 jg| 二 0， 或 者 |p1 二 0， 也 即 4=0 或 
Am 时 gx 一 0 才 有 可 能 。 
- 邯 六 请 四 元 数 相 乘 ， 当 其 因子 循环 牙 换 时 ， 四 元 数 乘积 的 
: 棕 量 部 分 不 变 。 即 
Scal[ hxgqxp] =Scal[ qxp*%h] =Scalf pxhxq] 
(1.36) 
但 Scal[ 4sxgqxp] SScal[Ax2xg] 
证 
Scalf%xqxp] =Scal{ (ho + A)*[qo po ~- (QDp) 
十 go 多 十 G2o + (gq xp)1} 
一 和 oko2o -Mo (GP) — qo AD) 
— (7.8)po - A.(g xp) 


A A2 hs 
d1 92 {3 
21 pe Ds 
故 因 子 循 环 置换 上 时， 乘积 的 标量 部 分 不 变 ， 而 非 循 环 置换 时 ， 
则 不 相等 。 

(7) 三 个 四 元 数 相 乘 ， 当 因子 循环 置换 睹 ， 四 元 数 乘积 的 
矢量 部 分 不 相等 ， 即 

Vect[Axgqxp] < Vect[gxpx%] 


A'(gqx Dp)= 








Vect[Axqxp] =Vect[ pxgx%] (1.37) 


[证 ] 关 
~ Vect[ hxgxp] = hg p+ hopog+ gopo h- (和 
th (gxp)+go (Axp) 
+ po (hxXq) thx (gxp) 
=h0g p+ hp gt+ gopo j i 
十 处 oq p) + go (hxp)+ po (hxg) 
-220)2X+QC2 2 -phg 
=Vect[pxgx%] AVeet [gxpx4] , 





§ 3 四 元 数 的 规范 化 形式 及 其 球面 
表示 法 


” 设 任意 四 元 数 . 
2 一 00 上 ?二 2 二 Ask (1.38) 


利用 以 下 方法 将 其 规范 化 。 将 写成 





11i 十 义 。j 十 义 KR、 
4 一 n(n WO + NW ) 





=N(%) (zw t(D ) (1.39) 





式 中 范 数 (4) 一 V 和 十 和 十 和 二 王 称 为 四 元 数 的 张 量 


4 入 yp 0 局 
WO t+ 责 ( 和 5 称 为 四 元 数 的 回 量 。 


引入 单位 矢量 5 ， 则 





则 回 量 的 矢量 部 分 


”7T2 








2 3 十 28 二 和 
= 1.41 
和 (4) b TAT ta .41) 
则 
_ vf VT 
和 和 (1.42) 


这 就 是 四 元 数 的 规范 化 ， 因 为 规范 四 元 数 的 标量 部 分 的 平方 
Cjo/ N)* 与 单位 矢量 5 的 系数 的 平方 (VE 二 和 十 和 AN) 之 
知 =eosg， 尽 人 4 二 合十 全 一 sih00KO<T 
(1.43) 
则 四 元 数 ) 一 N(cosbTCsin0) (1.44) 
角 9 的 符号 取决 于 单位 矢量 5 的 符号 选择 ， 也 即 是 《 方向 的 选 
择 。 

用 (1.44) 式 来 表示 四 元 数 ， 运 算 起 来 是 很 方便 的 ， 因 为 
《ext - (一 -1， 与 复数 相似 ， 可 以 有 类 似 于 棣 莫 佛 公式 
的 结果 ， 即 | 

A"=N"(cos0 -Csing)"—= N"(cosn0 + CsinnO) 
(1.45) 
对 于 任何 次 赛 ”都 是 正确 的 。 

利用 (1.44) 式 ， 可 以 得 到 直观 的 四 元 数 几 何 解释 ， 研 究 规 

范 四 元 数 瑟 . 
E=cos0 + tsing 
在 垂直 于 《的 平面 上 选择 两 个 矢量 如 图 1.3. 


| 


(1.46 
已 一 5 ii 十 Dj 十 2sK ) 
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arcE ， 
” 久 1.3 规范 四 元 数 的 几何 表示 图 
此 两 矢量 满足 如 下 条 件 ， 
(1) 令 a=~Vial ， b=~ [ol, 则 a 二 & 
(2) @ 与 5 之 间 夹 角 为 9 ， 
(3) a、5、6 构 成 右 旋 坐 标 系 (不 一 定 是 正 交 的 ) 。 如 图 
1.3， 图 中 规定 了 5 和 8 的 正 向 。 则 1 


再 一 cosg 上 fsing = abcos0 十 6apbsinb braxb 
lel ~ ef 


-~ Scal(@axb) +Vect(axb) 
jal 








= _Scal(Oxtz) + Vect(bxa)_ bra _ bra* 
‘al lal lal 
一 pro (1.47) 
玖 任 一 规范 四 元 数 可 以 用 单位 矢量 6 的 垂直 平面 上 两 矢量 四 元 
数 之 积 来 表示 。 
研究 图 1.3 可 以 发现， 规范 四 元 数 刀 可 单 值 地 用 大 圆 弧 
arcB 表示 。arcB 所 在 的 平面 取决 于 矢量 6， 而 弧 长 取决 于 0. 
其 方向 由 矢量 6 的 方向 来 确定 。 注 意 ; 弧 召 在 其 大 圆 上 的 位 置 
是 任意 的 ， 即 可 以 滑动 的 。 
研究 几 种 特殊 情况 ， 
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当 0=0 时 ,如 ==1， 相 当 旋 球面 上 的 任意 一 点 ,6 可 具有 任 
意 方向 。 
当 9 二 x 时 ， 轧 = -1, 相当 于 半圆 弧 ，6 可 具有 任意 方向 。 


当 0=3 时 ,B= 





如 图 1.3，arcB 二 4B 对 应 于 四 元 数 ， 因 
BE-1i=~E*=cos0 - 《sinb (1.48) 
为 沿 6 反 向 转 0 角 ， 对 应 于 B4 弧 ， | 
~ B=-cos0- tsin0=cos(x ~ 0)- Csin(m — 0) 
(1.49) 
为 沿 6 反 向 转 x- 9 角 ， 对 应 于 4'B 弧 。 
进一步 研究 四 元 数 乘法 运算 在 球面 上 的 表示 法 。 
设 g、2 为 两 个 给 定 的 规范 四 元 数 
g=cos0 十 0sin0 ， 
2 一 cos0 + psinO, 
如 图 1.4 作 单位 球 ， 过 球 心 o 作 矢 量 g， 并 在 与 其 相 垂直 的 大 圆 





图 1.4 四 元 数 乘法 运算 在 球面 上 的 表示 
面 上 作 矢 量 w 和 已， 其 夹 角 为 6,， 则 


gq=bxa-! 
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arcAB 对 应 于 四 元 数 g. 
作 矢 量 p， 并 在 与 其 相 垂直 的 大 圆 面 上 作 儿 量 c 和 ee， 其 夹 
角 为 2。， 则 
2 一 本 kxC-1 
arcO 4 对 应 于 四 元 数 ?， 
arcC B=arc0 A+arcAB (1.50) 
如 果 设 arcCB 对 应 于 四 元 数 N， 则 入 垂直 于 矢量 c 和 5 所 确定 的 
平面 ， 则 
N=bxc 1=bxg- ixaxc-!—gxyp (1.51) 
故 知 球面 上 各 对 的 几何 加 法 运算 ， 对 应 于 相应 的 四 元 数 的 乘法 
运算 ， 其 次 序 相反 。 
arcp +arcg=arc(gxp) (1.52) 
由 于 四 元 数 所 对 应 的 弧 是 可 以 滑动 的 ， 将 4B 弧 背 动 至 4， 并 
设 GF=f， 则 
¢=@xf"! 
将 C4 弧 滑 动 至 4D， 并 设 0D=d， 则 
p=dx@-! 
连 大 圆 线 FD， 则 FD 为 对 了 4 与 4D 的 几何 和 ， 设 对 应 于 弧 
了 FD 的 四 元 数 为 N'， 则 入 ' 垂 直 于 由 矢量 f 和 ad 所 确定 的 平面 ， 
则 
N’'=dxf-!=dxa-ixgxf-!=pxg (1.53) 
即 arcg + arcp=—arc(p*g) | (1.54) 
由 此 可 以 看 出 四 元 数 乘法 运算 时 ， 交 换 因子 所 发 生 的 情 
况 。 在 球面 上 ， 弧 段 的 加 法 运算 不 适合 交换 律 ， 即 


atc2 十 afcdgssarcg +arcp (1.55) 
当 三 个 大 圆 弧 2、&、2 几 何 相 加 时 ， 则 
arcp+arcg+arcAh=arc(Axgxp) (1.56). 


故 每 个 大 圆 弧 都 是 由 一 个 四 元 数 给 定 的 ， 若 干 个 大 图 绝 之 和 ， 
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给 出 一 个 由 这 些 四 元 数 相反 顺序 的 乘积 所 决定 的 大 圆 绝 。 
因为 等 于 1 的 四 元 数 相当 于 球面 上 的 一 点 ， 故 对 于 闭合 球 
面 三 角形 如 图 1.5 所 示 ， 有 
arcA+arcg+arcp=0 


期 arc(pxgqxh)=0 (1.57) 
2xGx 勾 一] (1.58) 
疏 Nn Nhn- 1 NN] 二 1 


表示 对 应 于 和 441、4。、…%,-1、4s 的 绝 构 成 闭合 球面 多 边 形 。 
利用 以 上 性 质 ， 可 导出 所 有 的 球面 三 角 公 式 。 





图 1.5 单位 四 元 数 的 球面 表示 。 图 1.6 球面 三 角形 的 四 元 数 表示 法 
例 正弦 定理 和 余 苞 定理 的 推导 
如 图 1.6， 球 面 三 角形 epce 其 三 边 所 对 应 的 四 元 数 为 
A=axb-!=cosa 十 Csina 
| 一 Cx2 -1 一 cos6 二 HSsinp (1.59) 
IN=cexb-!1=cosy+ ysiny 
式 中 gw、 有 8 、? 为 矢量 @、5、c 之 间 的 夹 角 ， 分别 对 应 于 四 元 数 
有 及、 以 、N 的 弧 长 ， 因 
arcA--arcM=arc(Mxh) =arceN 
歼 (cos6 +71sinpB)x*(cosw 十 《sina) 
=608y + ysiny (1.60) 


了 7 


即 cospcosw - (MU ee)sinpsina + usinfcosa 
十 《cospsinw + (Hx Et Jsinfsina 一 QoS? 十 ?siny 
《1.61) 
设 由 矢量 j 和 所 夹 的 角 为 (+ - 4) ， 则 球面 三 角形 a 点 的 顶 角 
为 4. 
Hx6=—- (H.C6)+ (nx 6) 
一 -cos(T- A)- asin(z — A) 
故 PRx6 一 cos4 - asin4 
代入 (1.61) 式 ， 则 得 ， 
cospcosa +sinpsinacos A 二 cosy ( 余 荡 定理 ) 
(1.62) 
Hsinpcosw + Csinacosp - asin Asinpsina 
= ysiny (1.63) 
以 Q 点 乘 (1.63) 式 两 边 ， 因 
QH=a.6=0 
CC 一 1 
故 -sin4sinpsina =a.ysiny =@.(b x ec) 
即 4 国 ee (1.64) 
当 矢 量 和 和 角 循 环 署 换 时 ，(1.64) 式 右边 冬 积 不 变 ， 故 得 正弦 定 
理 . 





sinA_sinB_sinO 
sinp sinf sina - 


$4 用 四 元 数 旋转 变换 表示 空间 


定点 旋转 
首先 研究 矢量 在 空间 绕 定 点 的 旋转 。 





(1.65) 
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由 欧 拉 定理 知 ， 空 间 绕 定点 旋转 ， 在 瞬间 必须 是 绕 一 欧 拉 
轴 旋 转 一 角 : 如 图 1,3 所 示 ， 图 中 矢量 7 绕 定 点 :0 旋转 至 ， 设 
互 为 矢量 7 绕 定 点 o 旋转 的 瞬时 欧 拉 轴 ， 其 转角 为 w，4% 在 





图 1.7 定点 旋转 的 四 元 数 表示 法 

垂直 于 也 轴 的 平面 9 上 ，2 为 忆 轴 在 8 平面 上 的 交点 ， 图 中 
OM=7?,， ON=r'。 作 | 
KN| MP 


则 . r'=ON=OM+ MK+EKN 
而 IMK|=|IMP|I-|IEP|I 
=|MP|- |NPl|cosa 
=|MP|(1-cosa) 
则 MK=(1 -cosa) MP 
=(1-cosa) (OP- OM) 
E 


二 8 有 . _E. 
OP=( rE BE TE 


(1.66) 


(1.67) 


(1.68) 


KN 矢量 的 方向 与 (OP x OQ 用) 方向 相同 ， 其 长 度 
[KN|=|MP|sing= |r |sinpsina 


故 KN= (二 -xz Jsina 


| 五 | 


将 其 代入 (1,66) 式 得 


个 ‘=r+ (Geoso)| 人、 :五 ) 一 云 一 -Er 一 了 | 


+ xr Jsina 


一 ?coSQw 十 (1 





E 
1El? 


+( xr )sina 


其 次 ， 根 据 矢量 7 定义 一 四 元 数 


R=r,6 十 分 


这 里 7o 一 | 人 | 


再 根据 矢量 五 和 角 w 定义 一 四 元 数 


QQ 有 ，w 
0 一 Bl(eos 和 + 盏 [san 3) 


研究 四 元 数 变换 


qxReg- 


gx*R*g !=R 


1 一 Bi(eos 和 + 再 [sin $) (ro +?) 


*| | 五 (es 字 一 而 fin rr] 


(1.69) 


(1.70) 


(1.71) 


(1.72) 


(1.73) 
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一 人 有 i 作 并 各 
= t (cos G+ [| Sin Eh 


*(cos « 全 一 证 ein 人 4) 


coso. 十 二 一 BT ng)r "( COS 2 _ E 


( 
-{[- Tr r ) sin gl 


3 TET 








十 | ? 时 )osg oing 

十 (本 fx ) 再 [sa 4] 

{cos2 0 + 人 (本 x Jsing Cos 
五 [7 JIET 了 
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一 全 2 2 五 卉 全 了 C & 
COS + Tx7 ) sing cosg 
(EE E 20_ C 

(到 7 再 Tsin 五 rsin® 3 
E \B ,20 





一 ?cosw 十 (1 -cosw) (rE)- Er 


+ 再 [xy )sina (1.75) 


比较 (1.70) 和 (1.75) 式 ， 两 者 是 完全 相同 的 ， 故 得 定理 如 下 。 
定理 设 g 和 有 为 非 标 量 四 元 数 ， 如 果 令 


a 五 .wuw 
4 一 | 五 | (sos 和 + 十 | sin2 (1.76) 
则 R’'=gxRxg-! (1.77) 
是 四 元 数 , 其 范 数 和 标量 与 四 元 数 忆 相同 , 其 矢量 部 分 VectR' 为 
Vect 尽 绕 欧 拉 轴 五 旋转 a 角 。 
因此 ， 绕 定点 矢量 旋转 可 以 用 四 元 数 变换 来 表示 ， (1.777) 
式 的 变换 称 为 旋转 变换 。 
如 果 令 
R=7o +?=7ro 十 ii 十 ?oj 十 sk (1.78) 
R'=rot+r’=r +riitrijt rik (1.79) 
2 一 9o 十 qii 十 gsj 十 &sk (1.80) 


利用 旋转 变换 (1.77) 式 ,可 得 和 R' 各 分 量 之 闻 的 关系 。 


r'=0+gt— gg 十 2(919 2 0 
lal i 


+ 9g rs 
| 


人 一 2(91 gz + qo), + 时- @ + gq2— ge 
Nal lgl (1.81, 
+ god1) 
| 


7 一 2(919gs 一 goga)7 29293 + g091),, 
al 


+ 一 9 ~ 9 十 g37， 
lc9l 
当 旋 转变 换 四 元 数 9 是 规范 四 元 数 时 ，19|=1， 则 可 以 用 共 力 
妇 元 数 来 代 赫 逆 四 元 数 。 此 时 


Ts 


R'=gxRxg* (1.82) 
9 一 cos 可 二 《sin 可 (1.83) 
g*=cos 一 6sin 可 (1.84) 


则 两 矢量 “和 7 的 各 分 量 之 间 的 关系 可 以 用 矩阵 形式 来 表示 


71 0 十 9 一 0 一 0，2(91gs 一 %ogs) ，2(9193 十 9o9gz) 

| 7 | =|2(gigs + qos) ，0 一 人 十 对 一 人 ，2(9ags 一 go091) 

7 和 [2(g193— 9092) ,2(g243+9091) ，9 和 一 0 一 人 十 9 
?1 

“7 (1.85) 


?Ts 
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形式 9x( )*xg* 称 为 旋转 算 子 。 它 确定 角 为 o 的 旋转 。 
如 果 将 g 换 为 -g， 因 (9g)*= -gq*， 故 旋转 算 子 ( 一 9) * 
(x( 一 g)* 和 gx(”)xg* 给 出 相同 结果 ， 实 际 上 ， 因 


-9=eos( = - 和 )+(-6sin(= - 2) (1.86) 


表示 绕 -《 轴 旋转 (2r - wc) ， 故 结果 相同 ， 
因 gxxgx( )xg*xg 二 1x( )x1， 故 旋转 算 子 gxx( )xg 
输出 角度 为 a 的 反 向 旋转 。 因 为 


%— a 一 in< 一 -2 i 人 
对 二 cos 可 6sin 5 cos( 5 ) 十 tsin( 可 ) 
(1.87) 


如 果 规 范 四 元 数 g9 给 出 以 角度 ca 绕 轴 6 的 旋转 ,而 规范 四 元 
数 ? 给 出 以 角度 绕 轴 4 的 旋转 ， 则 顺序 旋转 9 和 2 相应 于 算 
子 
Pg#x( xgrxp*= (pxg)x( )x(pxg)* 


(1.88) 
因为 ?x9 也 是 规范 四 元 数 ， 如 令 1 
pxg=cos y+ ysin 多 (1.89) 


2 2 
则 两 次 顺序 旋转 的 结果 ， 用 以 角度 纺 绕 轴 ?Y 的 一 次 旋转 是 等 价 
的 ， 更 一 般 的 情况 是 ， 顺序 旋转 ?1， ha, 3s, , 2 和 一 次 旋转 
(hn hi 1 ) 是 等 价 的 。 
研究 一 种 特殊 旋转 作为 例子 。 : 
设 9 一 和 ， 即 4=cos 字 +sin， 则 转角 为 x 上肢 g*= 


cos TF ~ bsinT = -6=-g, 故 
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T= = — Cxrxt 
如 图 1:8 所 示 ， 变 换 -Cxrxt 
可 给 出 相 对 于 《 轴 对 称 的 矢 
量 ， 而 变换 6x( )x6 可 以 给 
出 同 矢量 -exe( )xt .相反 的 
矢量 ， 故 变换 bx( )xt 给 出 
原 矢量 的 镜 反 射 。 
两 次 变换 t 和 4 决定 的 顺 
序 镜 反 射 
UxCx(: )x6#n 
= (HxC)*( )x*(1x€) -1 图 1.8 用 四 元 数 变换 表示 镜 反 射 
因 Mx 二- (4.6)- (xz)=- (cosp 上 bsinp)，9 是 f 与 
4 的 交角 。 故 两 次 镜 反 射 等 价 于 绕 该 两 平面 交 线 ， 以 两 平面 间 
交角 的 2 倍 旋转 的 结果 。 


村 
究 具有 单位 矢量 61、es、es 的 直角 坐标 系 思 和 以 单位 和 


gi is、%s 为 轴 的 坐标 系 了 之 间 的 坐标 变换 。 
如 图 1.9， 设 坐标 系 了 中 某 一 不 变 矢量 


沁 一 7 171 十 ?ob 十 Tatsg 


如 果 将 化 标 系 了 转 到 坐标 系 ， 此 时 矢量 7 随 坐 标 系 一 起 旋转 
成 r'， 它 在 原 坐 标 系 了 中 的 分 量 为 





分 /一 人 十 了 0 + r,s (1.90) 


则 ri 、z4 、7 与 r; 、ra 、7s 之 间 的 关系 由 (1.85) 式 确定 。 
如 果 规 范 四 元 数 4 为 旋转 四 元 数 ， 则 由 (1.85) 式 两 边 转 置 
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图 1.9 坐标 系 妃 ,7 关系 示意 图 


[ri,r2,73] = [71, 72 ,73] 
gi+gi- qi- gq8, 2(g1g92 + 9093) ;, 2(9193 ~ qo qs) 
“|2(9192 -gogs) ，98 ~ gf+gs-g3, 2(gs4s +q0g1) 
2(9193+ 9g09) , 2(9293 — 4091) ， gq$—g?— q+gs 
(1.91) 


区 
98 十 9 一 2 一生 ，2(gxgs 十 909s) ，2(9i9gs -0&oga) 
“|2(g192 -9093) , 93~ gs+g-g, 2(g9293+ 90g1) 
2(g193+9092) ，2(929s -9091) ，98 ~ 9? ~ g3+g? 
少 1 了 
-| (1.92) 


is 
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因为 ?是 不 变 矢 量 ， 随 坐标 系 了 转 成 r' ， 则 “对 坐标 夭 召 的 分 
量 与 r 对 坐标 系 工 的 分 量 相同 ， 即 
、 ?1 el - 
-me (1.93) 


7 一 [ri, rg, 78] ts 








ts 


与 (1.92) 式 比较 ， 则 


el 
es» 
es 


gi +qt— gq2—g3, 2(g192 + 9043) ; 2(9193— go0g2) 
=|2(g192 - 9093) ， 93 -471+q2 -gqg3, 2(q293+ qo0g1) 
2(q193+ 9092) ， 2 deg gg,) ， 93- gq- q+g3 


2 
上 B21, B22, D2s :| (1.94) 
Vs Bali, Da2, Dss ?3 . 
(14.9) 式 天 未 毕 标 未 与 人 标 系 了 之 问 的 关系 。 通 过 四 元 数 9 
写 出 了 他 们 之 间 的 方向 余弦 阵 。 它 表示 两 坐标 系 单位 矢量 之 间 
的 关系 ， 即 坐标 变换 。 如 果 用 Rs 表示 联系 于 坐标 系 召 的 四 元 
数 ，Ri 表 示 联 系 于 坐标 系 了 的 四 元 数 ， 则 坐标 变换 可 以 用 如 下 
的 四 元 数 形式 表示 之 。 
Ry=q*x*xRrxg (1, 95 

而 (1.85) 式 则 是 表示 对 同一 坐标 系 ， 不 变 矢 量 旋转 后 ， 其 分 
之 间 的 关系 。 可 以 看 出 两 变换 系 阵 是 互 为 转 置 的 。 

坐标 变换 矩阵 是 正 交 录 阵 ， 其 detB=1。 由 欧 拉 定理 知 
矩阵 至 确 定 的 变换 使 一 轴 保 持 不 变 ， 此 轴 即 欧 拉 轴 ， 它 是 年 阵 
B 对 于 特征 值 为 1 的 特征 矢量 。 设 特征 矢量 为 百 , 特征 值 为 4， 
则 - ; 


bii, bis, bis 


一 5|- 




















BE=1I1E 


Ba 
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(B~41)E=0 (1.96) 
此 方程 的 标量 形式 为 | 
. (bi 一 A)E, + bE, +biaBs=—0 
buB ,+ (bs— A)B, +b2sEs=0 (1.97) 


baBit+bssE2+(bss— Nh)Bs=0 


欧 拉 轴 对 应 于 2=1， 解 (1.97) 式 ， 即 可 确定 欧 拉 轴 ;; 准确 到 
任 一 因子 。 


如 果 考虑 到 变换 四 元 数 
BEI(cs 区 + 一 Pa 有 $4) 
如 果 令 |E|=1， 则 


9 一 cos 忆 十 E sin$ go +qrirgitgqsk (1:98) 


矢量 巨 即 是 欧 拉 轴 方 向 的 单位 矢量， 设 在 所 研究 的 坐标 系 上 
(例如 坐标 系 工 ) 的 分 量 为 B,、 思 2。 、 如 98， 则 





go =c0s$， qi1=isins, gs —Busins, gs =Basins 
(1.99) 
代入 (1.94) 式 ， 可 得 : 


及 ,一 2 一 Daa B, = bs1 ~— ba -bs nd 
2sin@ 2sin@g 2sina 
cosa 一 可 (ba 十 Das 十 Dos DD 


则 
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-万 ;一 bzs — ba2 
M4- (1- bi- bo — bss)? 
-bb 
E . U3 
2 4 i Bi — B22 — - bs) 2 


Dia 一 021 
4- (TD 一 baz 一 5033)2 








| 





:= 





* (1.100) 


由 (1.99) 式 所 确定 的 四 元 数 分 量 ， 称 为 罗 得 里 格 -哈密 顿 参 


数 。 


86 转动 的 相 加 和 连续 的 坐标 变换 
上 一 池 研 究 了 矢量 旋转 和 坐标 系 变换 的 四 元 数 表示 法。 本 
节 进 一 步 研究 连续 的 矢量 旋转 和 连续 的 坐标 变换 的 运算 方法 。 
我 们 已 经 知道 ， 矩 阵 的 乘法 对 应 于 转动 相 加 ， 如 果 第 一 次 


转动 将 矢量 r 转 成 >'， 由 矩阵 4 给 定 
r’= Ar 

其 四 元 数 表示 为 
Tr’=gxr#g* 

式 中 9 一 cos 了 十 和 sin 人 

六 一次 者 和 放大 由 和 撼 阵 给 定 
7 "一 Br 一 B4r 一 CT 

其 四 元 数 表 示 为 

rT”=pT p= pT (PE) = MTEAY 

式 中 

p=cos T+ 62sin 2 


2 


a a 
N=cos—!l2 + Ci2sin—!2 
2 2 


(1.101) 


(1.102) 


(1.103) 


(1.104) 


(1.105) 


(1.106) 


(1.107) 
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由 四 元 数 乘法 规则 ， 有 


A 
ha 22 ， Pps， Bo， 一 ?il92 
hs ps, ~ p> 21， 2o ! gs 
do -11 -qs，, ~ 43]rpo 
21， do， ds， 一 gz|1|121 (1.108) 
22， 一 03， go， 2Z1||22 
QZs， ga， 一 0 和， dol tps 
其 次 研究 连续 的 坐标 变换 。 与 矢量 转动 相 类 似 ， 设 矢量 ?4 联 
系 于 坐标 系 4 ， 即 


Ra=r71iia+ roisa +Tradsa (1.109) 
将 坐标 系 4 转 至 坐标 系 互 ， 且 令 
Ra=71iig++ rs op ratsB (1.110) 
财 
Ra—y**Raxg (1.111) 
4 为 把 坐标 系 4 转 成 坐标 系 B 的 四 元 数 。 
如 果 再 将 坐标 系 B 转 至 坐标 系 C 的 四 元 数 为 ， 且 令 
Ro=riiic+ roaiso + rtsc (1.112) 
则 Ra= p*#Rp*p= Dxg*#xRaxgxp 
= (gxp) "Ras(gxy) (1.113) 
如 果 设 将 坐标 系 4 转 至 坐标 系 C 的 四 元 数 为 4， 则 
Roa= A*xRaxn (1.114》 


do Td1; ~G2, -G31fpo 
gis 0 -ds， gz| 2 
Qa, 9s， ， 9， 一 和:||2a 
Za ~ ‘gd, 9oJLps 
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po, -pi, pe, Ps|[r9o 
_|p1; Peo， Pps, ~ ps||91 
pa， ~ Pa; po, Pi||92 

Pps» 22， 一 21， Pe gj 


(1.115) 


比较 (1.108) 和 (1.115) 式 ， 可 以 看 出 矢量 旋转 和 坐标 变换 的 区 
别 在 于 四 元 数 乘积 因子 互相 交换 ， 而 从 抢 阵 .表示 的 形式 上 来 


看 ， 该 矩阵 互 为 转 置 。 
如 果 引 入 符号 
do; T0901 TI da 
LO)1= di， Yo, 4s， 9 3 
gd2， (3, gg， 和 ia 
dds, Td; Qi; do 
go， 01, ~ 42) | 
[M*(q)] = 21， do， aa， 一 42/ 
. d2， — Ys， go， g | 
da， dg， 一 Qi， go 





go po 20 
1 1 A 
Qs4= 4 多 Qes = ? 多 如 c4 一 
22 2 . A2 
lgs ps 4 
出 ca= [M3s(p)Qs4= [Mpa(qg)] Qo 
如 果 有 四 个 坐标 系 如 下 : 
A >B_ ?sO yD 
| DV + 
莉 Gor= [M$o( A)] [MSs(p)] Qsa(g) . 


= [M$o(4)] [Maga(q)] on(p) 
=[Mss(q) [Mo (Nh) Qo (gp) 


(1,116) 


(1.117) 


(1.118) 
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故 oe OI Mea g)] = [Msg)] [M35e(h)]. 
(1. 119) 
利用 上 面 所 述 的 连续 坐标 变换 公式 ， 可 以 建立 变换 四 元 数 与 欧 
拉 角 之 间 的 关系 。 
如 图 1.10， 设 坐标 系 ozogyoz 通过 gq、、y 转 到 坐标 系 








图 1.10 体 坐 标 系 与 惯性 坐标 系 关系 示意 图 
‘OVIY ZL 其 转换 次 序 如 下 : 


9 rt 也 rot 7 
0X08020 一 >07 Y 20 一 >021 2 一 一 >0718121 
9 » » 


(4) (B) 0) (D) 
| 人 





基 对 应 的 四 元 数 为 BB、 妇 、 厂 ， 则 
9 =cos2 二 24sin 轩 ， Q34= ( cos?, 0, 0, sin 罗 ) 
2 2 \ 2 . 


区 一 eos 区 十 iaasin 委 ， Qi =\ (eosy, 0, sin 0) 
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T=cos 才 +itosin 方 ， QPe =( cos 攻 sin 委 ,0,0 


2 
QBa(N)=(No, Ni, Ns, Nas) 
因 N=DxPxT 


J sin 
Cos sin 可， 0 ， 








y 
c 
98 COS 


0) 
2° 2° 





0~ -cos - 

















» 
2 
sin} cos cos ~ cosy sin 
2 2 2 
» 
2 


COS y sin 


5 COS 有 十 sin COS 一 





siny sinY cos 9 a 
sins sin 可 cos 可 十 c08 可 fo8 


(i.120> 
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反 过 来 ， 亦 可 以 用 四 元 数 No, Ni, Ne.,Ns 来 表示 欧 拉 角 gp， 
pp, yy. 已 知 

Ni+NI-N3-NS ，2(NINerNoNa)，2(NiN -NiN，) 
2(N i Ns-NoNs), NE-NI+NS-N3 , 2(No Na NoNi) 
2CN1Ns+ No N,), 3(w Na~No ND), NINI-NS+N3 


f COSPCOSY ， Cosypsing ， ~ Siny 

| sinysinycosg sinysinysing sinycosy 

; — cosysing ， 十 Cos))coSO ， 一 
"cosysinypcosgp cosysinygsing cosycosp 
+sinysing 、 ， -sinyecosg ， 


淫 

2(N1N, +NoNs) 
WNIT NI- NIN3 
Sinp=2( No N, -NN;,) 
2(NoNI+N,N;,) 
NI- NI NS+N3 
NI NI+ NE+ N= 


tgp = 





(1.121) 
tgy = 





人 
NR 


第 二 章 站 元 全 人 方程 的 建立 


81 引言 oe 


在 利用 欧 拉 角 来 确定 刚体 在 空间 的 姿态 时 ， 过 于 立 刚体 
旋转 角速度 与 欧 拉 角 导数 之 间 的 关系 式 以 建立 欧 拉 状 程 。 当 刚 
体 对 参考 坐标 系 旋 转角 速度 已 知 时 ， 通 过 解 欧 拉 方 程 ， 即 可 求 
出 任 一 瞬间 的 欧 拉 角 ， 确 定 刚体 瞬时 在 空间 的 姿态 。 如 第 一 章 
第 一 节 所 述 ， 由 于 欧 拉 方程 为 非 线性 方 穆 ， 且 当 大 姿态 角 时 
(各 % 一 加)， 广 各 是 奇异 的 。 为 此 我 们 起 用 四 元 数 玉 代替 
拉 角 。 

上 一 章 已 经 研究 了 四 元 数 的 基本 性 质 及 两 生 标 系 旦 标 上 
换 的 四 元 数 表示 法 ， 并 给 出 了 四 元 数 和 欧 拉 角 之 间 的 关系 。 为 
了 能 用 四 元 数 来 研究 刚体 的 姿态 变化 ， 需 要 建立 刚体 旋转 角 速 
度 与 四 元 数 导数 之 间 的 关系 以 建立 四 元 数 方程 。 因 此 要 引入 无 
穷 小 变换 的 概念 。 

设 旋转 变换 四 元 数 为 4 ， 则 4 有 两 种 变换 形式 ， 将 矢量 
转换 成 矢量 r' 和 将 坐标 系 刀 转换 成 坐标 系 如 ， 以 下 分 别 来 叙 
述 。 

(1) 将 矢量 r 转 换 成 矢量 r' 

设 将 矢量 r 转 换 成 矢量 ~' 时 ， 两 者 的 位 置 相差 一 个 微量 的 
无 穷 小 变换 ， 它 对 应 于 一 个 无 穷 小 角度 4a 的 四 元 数 ， 设 其 所 
对 应 的 无 穷 小 变换 四 元 数 为 44 ， 则 
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Mh eos + ésinde =11 E+0(4a) 


. (2.1) 
式 中 6 为 瞬时 旋转 轴 ，4a 为 旋转 角 ， 0(49) 为 二 阶 以 上 无 穷 小 
量 ， 则 对 应 于 矢量 旋转 的 四 元 数 旋转 算 子 形式 为 


r= Ahrrx42*=( 工 十 6 )er ( 1— eA): O(d4a) 1 
("i 各 "(4-6 急 )rocn 


er rt brat (MY +ocan) 


(2.2) 
如 果 略 去 二 阶 微量 项 ， 则 得 下 列 矢 量 增 量 
位 = 笠 =(54o) xr 
. (2.3) 
《2.3) 式 两 边 同 除 以 4t， 并 取 极限 ， 则 
(be) roxr (2.4) 


4 (Za140) 表 示 将 r 转 成 7' 的 瞬时 旋转 角速度 矢量 @， 而 (2,.1) 式 
可 写成 


A4=1+ 寺 4 


其 4=1+#0d (2.5) 


《2.4) 式 与 矢量 微分 公式 相同 。 
(2) 将 坐标 系 吾 转换 成 从 标 系 怪 / 
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两 坐 标 系 转换 可 以 用 转换 矩阵 也 来 表示 ， 设 坐标 系 作 一 个 
无 穷 小 变换 ， 则 
B=I+€ (2.6) 
式 中 € 为 一 无 穷 小 算 子 。 
各 果 设 联系 于 些 标 系 刀 的 四 元 数 为 Rs, 联系 于 举 标 系 ' 的 
:四 元 教 为 Re ， 则 经 过 无 穷 小 变换 后 
i > Be/=(T+E)Rs=RstERs (2.7) 
' 玻 “ARzs=Ra'— Rs=€ERsz (2.8) 
现在 斋 要 确定 无 穷 小 增 量 算 子 E 与 旋转 角速度 @ 之 间 的 关系 。 
在 略 去 二 阶 微量 情况 下 ， 转 换 矩 阵 互 的 递 矩 阵 可 近似 写成 


B-1=I-€ (2.9) 
BB-!=(I+€)(T- €)~1 (2.10) 

对 正 交 箱 阵 来 说 ， 其 转 置 矩阵 等 于 其 逆 算 阵 ， 
则 B=I+€”=1- € (2.11) 
故 ET=-€ (2.12) 
即 Et 一 一 所 并 (2.13) 





图 2.1 无 穷 小 变换 示意 图 
故 知 无 穷 小 变换 矩阵 是 反对 称 矩 阵 ， 和 具有 如 下 形式 


37 


0 Elz €1s 0 E12 Eis 
< 一 Ecos 0 E23 |=|-Eais 0 E23 
Es Eaz 0 -E11 ~E€E23 0 
(2.14) 


如 图 2.1， 设 无 穷 小 增 量 算 子 eE ， 将 坐标 系 已 (el ez,es) 转换 
到 BE'(e',e!,e!), 则 和 可 以 用 方向 余 绪 表示 总 ~- 因 ~ 


el.el efi.ery 61.es 
B=|es':e, ee el.es 


eel ee el.el 














1cos4as ， cos( £ -40s ), 6 Ta 让 
| | 
= cos(F +40s )， cossw ， cos( 王 - do) 
| 
os( 到 -4as ), cos(F + 4 )，cosda - 
0 Aas — Aa, 
=J1+| - 4as 0 4wi |=7+E (2.15) 
da， ~ Ae 0 | 
改 0 Aags — Aas, 
所 一 — Aas 0 Aai 
Aa, ~- 4w， 0 
0 Aas Aas, 
A A¢ 
一 _ 4ws da 
Hi 0 天 4 
Aas, La 
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当 4t->0 时 ， 取 极限 ， 用 角速度 0 来 表示 oii==1, 2, 3) ， 则 





at 
0 Os 一 2 
E=| -as 0 wi lat= Gat (2.16) 
2 一 0O) 0 





代入 (2.8) 式 ， 取 极限 ， 则 
WI3T28 — O27T38 
aRs= € Rg= ene 一 win x eat 
WaT1E OI1T2g 
(2.17) 


故 人 =-Q@Qzx Rs (2.18) 





比较 (2.4) 和 (2.18) 式 可 以 看 出 ， 联 系 于 坐标 系 的 四 元 数 矢 
量 ， 其 导数 与 矢量 导数 符号 相反 。 
最 后 来 看 一 下 无 穷 小 转动 的 合成 变换 。 先 看 极限 情况 。 


dhs adhdhi =(1+ 去 oadt jx(1+ tot) 
_ ,1 1 
=1+ (0 TO) -4 (02 01) dt) 十 


+ 于 (@: x OQ1) (06)? 
在 略 去 二 阶 微量 情况 下 
dhs=1+ (0 + Od (2.19) 


故 在 准确 到 二 阶 无 穷 小 的 情况 下 ， 诸 无 穷 小 转动 对 应 于 其 角 束 
度 相 加 ， 这 里 转动 的 次 序 即 乘法 顺序 不 起 作用 。 这 说 明 矢量 
@1+@2 在 无 穷 小 转动 相 邻 坐标 系 上 ， 准 确 到 二 阶 无 穷 小 量 的 


了 9 
投影 是 相同 的 。 
其 次 看 微量 转动 。 由 (2.1) 式 


Ahs = ANhaxAh, =| 本 B61 das +0(40) ] 


*[1+ 去 C1Aa1 +0(4a) | 
=1+ 2 (62 4as +61401)+O(4a, Aa,) 


一 1 十 去 0 十 二 0 (2.20) 


式 中 01=61401, 0, =6, 4as 
可 以 看 出 ， 在 略 去 二 阶 微量 时 ， 与 无 穷 小 转动 相似 。 


$2 四 元 数 方程 的 建立 
首先 研究 动 华 标 系 妃 对 固定 坐标 系 〈 异 性 坐标 系 ) 了 的 四 
元 数 方程 。 
设 有 Ri 为 联系 于 坐标 系 了 的 四 元 数 ，Rs 为 联系 于 坐标 系 吾 
的 四 元 数 ， 将 固定 坐标 系 工 转换 到 坐标 系 召 的 旋转 四 元 数 为 
2 ， 由 (1.95) 式 





Re=gq*xRixg 
两 边 微分 
< = Rixg + gx 人 *g + gxRix ga 
(2.21) 
因 了 为 固定 坐标 系 | 
aRj 
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且 知 
人 一 一 05x 玉 5 (2.22) 
Rixg=gxRs (2.23) 
gq*xR1= Rexgq* (2.24) 
因 gq**g 二 1 
*xdd— _ dg 
故 9 7 2 (2.25) 


将 以 上 关系 代入 (2.21) 式 ， 则 得 : 


x * 


一 2Vect (E+) x Ry= 2( 史 :9) X Rs 


at 
: “(2.26) 
况 
xyxd8- 工 
著 di So 
59 一 六 gxos (2.27) 


这 就 是 通过 坐标 系 旋转 角速度 在 召 坐 标 系 上 投影 来 表示 的 四 元 
数 方程 。 
如 果 将 角速度 @ 投 影 在 坐标 系 了 上 ， 则 因 
Op—q xg (2.28) 
将 (2.28) 式 代入 (2.27) 式 ， 则 得 ， 


二 OI*g (2.29) 
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将 (2.27) 式 和 (2.29) 式 表示 成 分 量 形式 ， 则 (2.27) 式 为 





[2o 0 ，-or， 一 osz， 一 0Osg1Tgo 
1&a 一 1 i@ig, 0 ， 〇 35， 一 0O20119) (2 30) 
记 2 D2E; 一 0 〇 35， 0 ， WI1p 122 
LOs OD3B， Oa25F， 一 COIp， 0 gs 

(2,29) 式 为 
go 1° ;OI Oat 0371790 
了 1|om, 0 ， ~ Oar, . O21 di1 (2.31) 
| 2 2 ,osr， CD37， 0 1 一 局 17 
lgs . lar, 一 Oo7) CI17， 0 qa- . 

如 果 利 用 (1.116) 式 的 表示 法 ? 则 ， 
4 一 寺 LM*(os)]@(9)= 卫 LM(O]g(oo) (2.32) 
%= 豆 [MoD]@() = 二 [M*(g)10 (67) (2.33) 


其 次 研究 动 坐标 系 召 ' 对 动 坐标 系 至 的 四 元 数 方程 。 
设 将 固定 坐标 系 工 转换 到 
动 坐标 系 怕 的 四 元 数 为 9， 角 7 二 ~ 和 pr 
速度 为 @， 如 图 2,2 所 示 .将 动 y 
坐标 系 玉 转换 到 动 坐标 系 到 /的 二 一 
四 元 数 为 4， 角速度 为 吕 。 将 ”图 2.2 坐标 系 间 的 关系 示意 图 
固定 坐标 系 1 转换 到 动 华 标 系 的 四 元 数 为 NW， 角速度 为 @0'。 
则 “ 
Ho=N (2.34) 
=xN (2.35) 
微分 (2.34) 式 
gx 四 十 gx 二. 
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pa =g*rxN 一 g*x0%h 


W= 寺 Nx@ob 
4 dor0; 
获 和 = gx 了 Na 一 9*0OaX% 


太一 1 Arb — 于 oa (2.36) 
如 果 设 @' 在 B' 坐 标 系 上 的 分 量 为 012+、w@2z'、@3a'3 @ 在 召 坐 
标 系 上 的 分 量 为 OIEs OW2E, Oape 则 (2.36) 式 可 写成 


了 了 ft 
， OF “O22E; ~ O38! 


p 0 
A _1 OQ1E!; 0 3 Qa, — Wap! 
和 | Zlloss, -oss 0 wiz 
hs 3B!s O28 ~ Ol1g’, 0 
0 ， -Os -2 — Ws3p]1) Tho 
O18 0 ， 一 03pg， 2pl | | A 
一 1 (2.37) 
@35， Wag, 0 ， 一 os|12a 
ag ~ OW2ps alip， 0 As 
如 果 考 虑 到 
=@+ (2.38) 


将 (2.38) 式 代入 (2.36) 式 ， 消 去 oz， 则 

py = 二 Ax 一 二 (OF — L288)*A 
式 中 @4 为 0' 在 召 坐 标 系 上 的 投影 ， 人 5 为 如 在 坐标 系 上 的 投 
影 。 


部 了 


辐 加入 一 下 站 一 Ms(@O a) (2.39) 
故 和 一 羡 hxa8 ~ 于 [hx(@om， ey 
故 和 = 六 4 (2.40) 


如 果 消 去 (2.36) 式 的 os ， 则 


让 十 和 py) 一 二 Qa 和 


Ax[Nxx(a + a)N] 一 二 ax 


歼 和 = 地 人 a 和 (2.41) 


将 (2.40)、(2.41) 式 与 (2.27)、(2.29) 式 进行 比较 ， 可 以 看 出 
形 如 (2.27) 或 (2.29) 式 的 四 元 数 方程 ， 它 描述 一 坐标 系 相对 于 
另 一 坐标 系 的 运动 ， 不 一 定 限于 动 坐标 系 对 国定 坐标 系 ， 如 果 

是 两 动 坐 标 系 ， 则 其 角速度 矢量 为 两 坐标 系 相 对 角速度 矢量 。 

四 元 数 方程 (2.27) 或 (2.29) 和 欧 拉 方程 (1.5) 一 样 ， 可 以 
确定 刚体 在 空间 的 姿态 。 由 四 元 数 方程 可 以 导出 欧 拉 方 程 。 

我 们 知道 刚体 绕 定 点 转动 总 可 以 分 解 成 为 绕 三 个 瞬时 欧 拉 
轴 的 平面 运动 ， 而 每 一 平面 运动 可 对 应 于 一 个 四 元 数 ， 因 此 有 
可 能 利用 四 元 数 之 积 的 形式 来 解 运 动 方 程 。 

设 将 坐标 系 工 转换 成 坐标 系 媚 ， 可 用 对 应 于 三 个 平面 旋转 
的 四 元 数 4, ，%。，%4, 来 表示 ， 则 将 坐标 系 了 转换 成 坐标 系 刀 
的 四 元 数 4 可 表示 为 


A=ANXAs Ns (2.42) 
且 设 2 和 ;= NOs (2 .43) 
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微分 


(2.42) 式 


2 二 2( 先 1 六 og 十 入 1 关 入 og 十 为 1 2 


二 XO NN NO Na 十 IWAg NN 


EE 1 关 有 3 关 放 3 


十 和 1A aA NG 十 多 1%A2 A 
= A¥(CASANEAO 1A AN 十 hI Ns + a) 


一 人 xDP 


区 @z= XxAEXO hos 十 CO3X 刀 3 十 (CD 
如 果 欧 拉 角 按 图 1.1 所 示 之 顺序 旋转 ， 则 


po =cos 凶 +iasin 儿 ， 4i 一 cos5 — LsSin 


则 


OO 一 0ia，0Oa =pis, Oa3= pil 








pp -eos 十 ?28Sin 5 ， 13 =cosy 一 ?2Sin 
一 cos 北 +isin2 A 一 cos 闭 ~ isiny 


2 2 “2 2 


& +» 4 





全 OA 


(2.44) 
(2.45) 


jxosx2s=( cos 基 -iasin 攻 Jay ) 


一 加 cosy -iypsiny 


AzxO :ja= (eos 区 一 加 Sin -二 所 9 )rpios *(cos + ZoSin $) 


2 
=isDeosyp - ii psinyg 
A AERO EN ) RNS 


=( cos¥ 一 iasin 攻 je Cispcosy -ipsiny) 


pp iciny 
*(cosZ +irsing) 


一 ~i psing+i, Psinycosy + is Peosycosy 
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履 0O8 一 ?1 (Dp — Psing) +is (peosy + Psinycosy) 
+is(Pcosycosy — Ysiny) 
= Oo tio Oy tbate 
故 Ozi 一 少 - Psiny 
Wy = Psinycosy + Yeosy 
Wzi—=PBeosycosy — Ysiny 


很 容易 化 成 (1.5) 式 形式 的 欧 拉 方 程 。 


$ 3” 四 元 数 方 程 的 研 究 

以 上 我 们 已 经 介绍 了 三 种 不 同类 型 的 参数 ， 即 欧 拉 角 、 方 
向 余弦 和 四 元 数 ， 借 助 于 这 些 运 动 学 参数 ， 都 可 以 确定 刚体 在 
空间 的 姿态 ， 其 方程 分 别 为 (1.5) 式 、(1.9) 式 和 (2.27) (或 
《2.29) 式 ) 式 。 欧 拉 方 程 是 三 个 非 线 性 方程 组 ， 有 -一 个 奇 点 ， 
在 此 点 方程 组 是 奇异 的 。 方 向 余弦 方程 是 九 个 线性 方程 组 ， 必 
须 满足 正 交 条 件 的 六 个 关系 式 ， 而 四 元 数 方程 是 四 个 线性 方程 
组 ， 只 需 满足 一 个 范 数 为 1 的 条 件 ， 故 与 其 他 两 种 参数 相 比 ， 
四 元 数 方程 具有 如 下 的 特点 。 

(1) 与 欧 拉 角速度 方程 不 同 ， 它 是 一 组 非 退化 的 线性 微分 
方程 ， 没 有 奇 点 ， 原 则 上 总 是 可 解 的 。 

(2) 与 方向 余弦 方程 相 比 ， 四 元 数 有 最 低 数目 的 非 退 化 参 
数 和 最 低 数目 的 联系 方程 ， 通 过 四 元 数 的 形式 运算 ， 可 单 值 地 
给 定 正 交 变换 的 运算 。 

《3) 四 元 数 可 以 明确 地 表示 出 刚体 运动 的 两 个 重要 物理 
量 ， 旋 转 欧 拉 轴 和 旋转 角 。 

(4) 四 元 数 代数 靶 ， 可 以 用 超 复 数 空间 矢量 来 表示 欧 拉 旋 
转 矢量 ， 超 复数 空间 与 三 维 实 空 间 相 对 应 。 

所 以 用 四 元 数 来 研究 刚体 的 运动 特性 ， 是 最 方便 的 。 

研究 方程 (3.27) 和 (2.29) ， 式 中 @s 和 @1 是 旋转 角速度 分 
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别 在 坐标 系 加 和 坐标 系 上 的 投影 ， 都 是 给 定 的 (已 知 的 ) 时 间 
函数 ， 其 标量 形式 都 是 四 个 线性 微分 方程 组 ， 为 了 给 出 (2.27) 
和 (2.29) 式 的 通 解 ， 有 以 下 定理 。 

定理 1 设 osg( 轨 ,or(b 已 知 ，Y ( 菇 是 四 元 数 方程 (2.27)》 
和 (2.29) 的 解 ， 则 四 元 数 


gz =Opx*N(t) (2.46) 
是 (2.27) 式 的 解 ， 而 
qri=N( xO (2.47) 


是 (2.29) 式 的 解 ， 其 中 Ce ，C7r 是 常 值 四 元 数 。 

此 定理 只 需 将 (2.46) 式 和 (2.47) 式 相应 的 代入 (2.27) 式 和 
(2.29) 式 ， 立 即 得 证 。 : 

通过 常数 Cr，Cr 的 适当 选择 ， 可 以 用 (2.46)、(2.47) 式 
来 表示 方程 (2.27)、(2.29) 满 足 所 需 起 始 条 件 的 任意 解 ， 所 以 . 
它们 是 相应 四 元 数 方程 的 通 解 。 对 任意 起 始 条 件 9z(t。)， 由 


(2.46) 式 4 

da 人 (ti) 一 CaxN(i) 一 CpxNo . 
故 Cz=ga(toOx Ns (2.48) 
同 理 Cr=Nixgr(i) (2.49) 


方程 (2.27) 和 (2.29) 是 刚体 同一 种 运动 的 两 种 不 同 的 描述 
形式 ， 它 们 的 解 应 该 是 相同 的 。 但 是 把 (2.46) 形 式 的 解 9s 代 入 
(2.29) 式 ， 则 


. 1: 
即 Os N (ros= 到 orxCaxN 人 (2.51) 


因为 四 元 数 入 (是 将 坐标 系 I 转换 成 坐标 系 妃 的 旋转 变换 四 
元 数 ,， 故 - 
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a= N*(t) rsN (t) (2.52) 
代入 (2.51) 式 ,得 
CgxW1—=Ox0Og (2, 53) 


由 于 四 元 数 乘法 是 不 能 交换 的 ， 故 在 一 般 情况 下 ，(2.53) 式 是 
不 能 成 立 的 。 除 非 满 足以 下 三 个 条 件 ， 

(1) 有 一 个 四 元 数 为 零 。 

(2) 共 线 ， 即 Cs 的 矢量 部 分 在 @ 方 向 上 。 

(3) Cz 二 4， 则 gz(to)xN$ 二 1， 同 理 亦 可 推出 Cr 一 和 
*gr(to)=1. | 
三 个 条 件 中 ， 只 有 第 三 条 是 可 能 的 。 由 此 可 以 看 出 ， 同 时 满足 
两 种 形式 方程 的 唯一 解 是 (2)， 

这 可 以 从 以 下 的 解释 中 看 出 其 物理 意义 ， 如 图 2.3 用 矢量 





图 2.3 坐标 系 召 ,了 与 四 元 数 N(t) 关 系 示 意图 

来 表示 坐标 系 ， 四 元 数 入 (2) 是 将 坐标 系 工 转换 成 坐标 系 吾 的 
转换 四 元 数 。 它 描述 由 于 角速度 oz 的 存在 ， 在 坐标 系 工 上 看 坐 
标 系 如 相对 于 了 的 运动 。 如 果 另 有 一 坐标 系 '， 亦 以 or 角 速 
度 相 对 于 坐标 系 工 运动 ， 则 它 和 坐标 系 刀 的 相对 位 置 不 变 ， 可 
以 由 常 值 四 元 数 Cr 确定 ， 且 都 满足 方程 (2;29) ， 才 四 元 数 方 
程 (2.29) 的 解 gz( 攻 = 六 (beCr 形 成 解 集 。 辣 理 ，(2.27) 式 的 
解 gz(t) 二 CgxN (it) 亦 形成 解 集 ， 两 解 集 的 交集 即 是 唯一 解 
V(t)。 因 此 有 如 下 定理 。 
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定理 2 ”对 于 刚体 的 同一 种 运动 来 说 ， 解 集 在 一 个 点 上 而 
只 能 在 一 个 点 上 相交 ， 解 N( 引 就 是 ' 属 于 两 个 解 集 的 交集 的 
上 ， 
实际 上 , 假定 W ( 妨 是 满足 两 种 形式 方程 (2.27) 和 (2.29) 的 
解 ， 且 知 此 时 
人 
Nyxgr(to)=1 
故 gs(to)= N(t)=gr(to) 
即 两 方程 具有 同一 起 始 条 件 ， 故 六 是 唯一 的 。W (是 两 种 
形式 方程 (2.27) 和 (2.29) 的 特 解 。 如 果 给 定 起 始 条 件 ， 任 取 一 
种 形式 的 方程 进行 积分 ， 所 得 的 解 亦 满 足 另 一 种 形式 的 方程 。 
故此 两 种 形式 的 方程 ， 实 际 表示 刚体 的 同一 运动 。 
如 果 对 角速度 @ 进 行 正 交 变 换 
@'= SOS* (2.55) 
出 @' 确 定 运 动 学 方程 ， 可 由 如 下 定理 得 到 。 
定理 5 设 入 (四 是 角速度 为 @() 的 运动 的 运动 学 方程 的 
解 。 若 角速度 


(2.54) 


O' =H%OS* 


这 里 5 是 常 值 四 元 数 ， 表 示 一 种 正 交 变换 ， 则 


N’=SxNxS* - (2.56) 
是 方程 
2 和 /一 四 1 和 一 用 0x0 (2.57) 
的 特 解 。- 
证 因 
的 =SxQI#8*, r= YA 
二 xzXGY ，008 一 人 xx 人 x 襄 (2.58) 


N=SeNxS，N 一 SnxxNorg 
将 其 代入 (2.27) 和 (2.29) 式 ， 则 
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2S*xN’'xS 一 (SY*x@I xS)* (SY AN sx) 


改 2XN' 一 OrxNr 

2S*xN 'xS=(S*xN’'xS)x(S*xO LS) 
故 2 太一 NixOA 
故 六 "是 方程 | . 


24 =O7*h 一 人 AGO 
的 特 解 。 ， 
如果 角 速度 矢量 函数 人 已 知 ， 则 @(t) /w(t) 为 单位 角 速 


度 矢量 。 人 下 罗 加 和 可 将 四 元 数 方 程 化 为 单位 角速度 矢 


,fu w(t) 0 (2.59) 
则 . 加 -ot0, t=p-1(0) (2.60) 


代入 (2.27) 和 (2.29) 式 ， 则 得 : 


器 = 十 2 g— 9 ry (2.61) 
以 上 研究 ;了 表示 刚体 运动 的 四 元 数 微 分 方程 解 的 唯一 一 性 。 下 面 
来 叙述 一 下 ， 在 某 些 特 殊 情 况 下 ， 四 元 数 方程 的 特点 。 
(1》 四 元 数 的 表示 法 
在 第 一 章 的 叙述 中 ， 我 们 已 知 四 元 数 单位 矢量 起 着 虚数 单 
位 的 作用 ， 即 6x6 = - 1， 类 似 于 偶数 表示 的 欧 拉 公式 。 四 元 
数 可 以 类 似 地 写 为 








_ GG _ G | 
g eos + Cain =exp( ca) (2.62) 


其 共 轿 四 元 数 
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"eos — tsing =exp( -£ 4) . (2.63) 
利用 棣 莫 佛 公式 ， 则 | 
roos(n) + tsin(n2)=oxp( tag) (2.64) 
”但 由 于 四 元 数 乘法 是 不 符合 交换 律 的 ， 故 
on eS) nh) zo 三 + 


2 
| (2.65) 
只 有 在 两 种 特殊 情况 下 ， 上 式 等 式 才能 成 立 。 
1) 6 和 2 共 线 ， 即 6 一 六 二 ， 则 
qx 二 exp( CH 5 Se 人 ze 人 vse) 
(2.66) 


实际 是 进行 平面 旋转 。 在 球面 豆 示 法 上 则 对 应 于 同 一 大 图 的 弧 
相 加 。 
2) “和 为 无 穷 小 量 ， 在 略 去 二 “ 阶 微量 情况 下 


wien( cE)eo( nA) 
EE 
和 


=1+€ +n f=exp( CF+ uf) (2.67) 


2 
《2) 四 元 数 的 导数 
四 元 数 对 时 间 的 导数 定义 为 


sf 


zg in 和 gD) 


ta … 








4 下 54 + = 76 (6) lt) 
A eA)| 


A 
(68) . 
指数 竹 可 展 成 级 数 . | 
Ct Ai) alt + At) ' }i : 
6 a + EW a At GD) oe) Mr0(4) 
“(2.69) 


由 于 不 能 将 指数 等 的 和 分 开 成 各 指数 的 乘积 ， 改 在 : 一 般 情况 
下 ，(2.68) 式 无 法 运算 。 
但 如 果 设 为 常 值 矢量 ， 则 指数 寡 (2169) 式 可 写成 
Gt ADalttA)=6oa(lt) reat ATOC(AD: + 


而 exp| 6 C+ 40 at+ 4D| ， 


=exp| 二 ce ex 人 fa 44004D]] 





，. (2.70) 
故 - 加 
dg jim exp| 6 ods) |*(exp [6ec a+0can | 一 1} ee, 
da 本 条 _- 
一 ezp[ 二 5et 牛 寺 Cao = ta rexp Bad] 
即 | (2.71) 


dg_!1 1 
= dg (2.72) 
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这 是 因为 《为 常 值 矢量 ，《 和 和 共 线 ， 故 因子 可 以 互 易 。 
与 (2.27)、(2.29) 式 比较 ， 可 以 着 出 它们 的 解 是 


N=exp (to) 2.73) 
而 角速度 Ot) =to(t) =€a0) (2.74) 
具有 不 变 方向 ， 此 两 式 的 通 解 为 

A 6¢ra(lt) :6 (2.75) 
qr = Oatexp [Eee ] (2.76) 
其 中 和 
alt) io ae ‘oD (2.77) 
因为 是 研究 同一 运动 ， 显 然 
qr(D=gtt) (2.78) 
,91(0)=01=gs(0)=0z ~ (2.79) 
改 i i 


Cyrlexp| $6rat | 小 = Crxexp B Csalt) | 


故 当 | Cs 一 O¥at 1405 i : J (2.80) 
即 Os =OFWIxO (2.81). 
得 到 满足 时 ， 水 有 gz 一 gs。 说 明 两 种 形式 的 四 元 数 方程 ， 仅 仅 
决定 于 某 一 给 冠 的 起 始 条 件 ， 当 Cr =1 时 ，W(bD 变 为 特 解 
(六 =exp 旧 二 | ecoer| (2.82) 


所 得 的 解 ， 表 示 在 固定 平面 上 的 旋转 运动 。 
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(3) 非常 值 四 元 数 进 行 正 交 变 换 时 ， 四 元 数 方程 解 的 研究 
定理 3 给 出 了 当 角 速 关 
@'=SxOxS* 
当 如 为 常 值 四 元 数 时 ， 
一 Sa NS 
是 方程 2 和 7 一 Orx 人 一 人 xs 
如 果 &8 为 非常 值 四 元 数 ， 则 当 
N’'=SxNxS* 
时 ， 求 微分 得 : . 
V’'—SxNxS*t SNxS*— SxNeS*xd Se* (2.83) 
假定 四 元 数 5S 满足 这 样 的 方程 
28 = ,x8 (2.84) 
而 2N =@IxN 
则 2N'—O xS NS Sx x NS* 
— SxNx*S*xl? SxS* 
=(QIxN’— NR 1) +OIrN!’ (2.85) 
而 | 2 和 一 Of 和 (2.86) 
可 以 看 出 ， 只 有 当 . 
QIN'- N's =0 (2.87) 
时 ，X ' 才 是 方程 (2.86) 的 解 ， 由 (2.87) 式 
QIxN'= NG， (2.88) 
只 有 当 恕 := 二 0 时 才能 成 立 ， 即 8 为 常 值 四 元 数 。 
(4) 刚体 运动 的 分 解 
刚体 的 空间 运动 可 以 分 解 成 为 很 多 简单 的 平面 运动 。 如 第 
二 节 由 四 元 数 方程 推导 欧 拉 方 程 那样 ， 将 空间 转动 分 解 成 为 三 
个 平面 转动 来 进行 推导 ， 则 每 个 简单 运动 都 对 应 于 一 个 四 元 
数 。 利 用 四 元 数 乘法 ， 即 可 确定 刚体 转动 。 设 


(2.,89) 
则 2 2 和 4，x 人 xx2 4 1 站 。 关 为 e 
十 ,十 入; 29。 本 ， 
一 (@1r 十 人 ixGDarx 人 十 思 ， 0 
十 os 十 让 1 关 久 geoo 关 多 On "六 
一 OrxA (2.90) 
故 OI=O17 二 hI1X0O21%A* 
hn mAs 1 


(2.91) 
假定 @Q11:，@21， …@a1 是 已 知 的 ， 则 本 以 求 出 0 和。 


$4 四 元 数 方程 的 解法 
一 、 四 元 数 方程 的 形式 解 
研究 一 个 无 穷 小 变换 四 元 数 
44 =exp [oe4D) 4t |， 0<<<1 (2.92) 


假定 在 时 间 区 间 [i,t+ 4 如 内 ， 角 速度 的 值 为 常数 且 等 于 其 在 
区 间 中 某 一 点 的 值 ， 使 4 趋 于 零 ， 取 极限 ， 则 得 到 四 元 数 增 量 
的 精确 值 

CO =exp [oc 、 (2.93) 
没 直 个 时 间 区 和 为 [9，] ， 将 其 分 成 = 个 邮电 4， 这 里 


A 4 


;为 菜 一 给 定常 数 ， b=1, en ， 
则 hbir1) = Ht) AN). 
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X(t)xexp [ost 1 Ai 1) 48， | (2.94) 


2 1) = horexp [二 0614t1) dt | 
xexp| 去 or(t: 十 5a At, ) 4| 


wotexp| os 十 Gi 1 Ati: 1) Ats, 1 | 
| (2.95) 


如 果 以 球面 上 的 弧 来 表示 四 元 数 ， 则 (2.95) 式 示意 图 如 图 2.4 
所 示 ， 如 果 增加 到 无 穷 大 ， 则 44->d4， 而 (2.95) 式 趋 近 于 


12710) 





人 RD) 
图 2.4 四 元 数 方程 解 的 图 示 法 
《2.27) 式 的 解 ， 此 时 | 


LL 
4 (全 ) 一 lim Dexp| 0st Ss ht) hhos | 
; 4 一 0 


(2.96) 


$6 
如 果 极 限 存在 ， 则 用 符号 来 表示 成 


hg(T) = hoxS oxp[ 二 os(Oat| (2.97) 
0 


它 是 方程 (2,27) 的 解 。 
同 理 方程 (2.29) 的 解 为 


T 1 | 
A1(T)=S exp[ 吉 oC) as] (2.98) 


方程 (2.97) 和 (2.98) 称 为 方程 (2.27) 和 (2.29) 的 形式 解 。 如 果 
角速度 矢量 方向 不 变 ， 则 


『 Soxr[ YouC0a] -exp[3 Ed 
| =I+ 到 | az (0 十 工 i| ‘oad 
+z os 二 
(2.99) 
Ed ee aR Ad 
-+ 下 | oOa+ 了 [oem 


1 
4 
| waa 十 





、 


Tz | 


二 、 四 元 数 方程 解 的 积分 表示 法 
以 (2.27) 式 为 例 ， 此 时 四 元 数 方程 为 


I 


和 = 于 ro 一 十 M*(oa)@(2) (2.100) 
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设 其 解 为 46)=At)xg(t) -(2.101) 
代入 (2.100) 式 得 
4 一 去 gx@8= EM*(0s)0 (9) (2.102) 
方程 (2,102) 的 解 满足 起 始 条 件 
q(t) 一 1 (2.103) 
其 解 可 写成 


世 
%=7+ 村 | s(t’) dt 
to 


1 t 本 n nn Hd 1 
+ 了 | 中 Oat) a les J + 
(2.104) 
如 果 @z( 纺 已 知 ， 则 利用 (2.104) 式 ， 可 以 得 到 g(t) 的 各 阶 近似 
解 。(2.,104) 式 与 (2.99) 式 不 同 ， 它 是 四 元 数 方程 在 起 始 条 件 
4(to) =1 下 的 精确 解 ， 但 是 它 是 以 多 重 积分 的 形式 来 表示 的 ， 
如 果 积 分 收敛 很 慢 ， 计 算 起 来 也 是 很 不 方便 的 。 
通常 os (机 的 值 不 能 瞬时 得 到 ， 原 始 信息 往往 .以 积分 步 长 
内 角速度 积分 的 形式 输入 。 如 果 令 四 元 数 
‘ad)=| wold .| (2.105) 
这 时 ， 在 第 #” 步 的 原始 信息 是 这 个 四 元 数 的 二 次 向 后 差分 
Aan=a(é,) alts,) = Si 


(2.106) 
如 果 令 


T= > 


bt 
(2.107) 


这 里 & 一 加- 加 - :为 积分 步 长 ， 则 %w (可 利用 四 阶 差分 向 后 插值 
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公式 表示 成 


a(7)=a(0) + (4， oa- lAsg4 工人 oa- Aa )r 


+( 下 如 a 一 二 如 4) + -44CT4 (2.108》 


Za(T) =( 1 43 1 a, la 
r= Ana 4i0t 可 480 40) 


+(48a ~ A3g+ asa )r 


+ (E43a- BAia)r ti Atar (2.109) 
由 于 各 阶 差分 均 为 常数 ， 故 将 (2， 108) 和 (2. 109) 式 代入 (2， 104) 
式 ， 即 可 求 出 四 元 数 4 。 
三 、 解 四 元 数 方 程 的 遂 推 法 
设计 算 步 长 为 4tx, 在 积分 步 长 区 向 内 令 


Op 一 Ozkel 十 OyKes + OKEs (2.110) 
[oz | 一 Ox 


Ox、@zx、@yK、@zk 均 为 常数 〈 可 取 积分 区 间 任 一 点 值 ) ， 定 
义 四 元 数 


Ag(te) = 一 cosOadtx |e Dazg gin Or Mix 
2 OK 2 ~ 

+ es Cur sin OK 区 OE 十 elyQax sin @rAix 

Ok OK 一 2 


(2.111) 


了 9 








则 g(trr1)=g(tr)* Aq(tx) (2.112) 
即 ， [gor+il Taor; -qixs -gar, — qsfl. 
d1k+1 二 Qik, dok, ~ Qa3r, Qax 
G2 K+1 G2 Ks GasK， GoE， ~ dirk 
‘da3k+1 ds3K; — deks dirk; “ok 
cos OE Ax ~ 
2 
:| Orr sin Or Mtr ， 
[or 2 
“| 1 (2.113) 
Oyg sin Ox Abr 
Og 2 
Ozg.gin OEMix 
OK 2 


和 此 反复 沁 推 ， 即 可 录 出 0 人), 多 于 在 2 区 间 内 取 仙 如 认 肥 其 
分 量 为 常数 ， 会 引起 计算 误差 。 


四 、 数 值 积分 法 求 四 元 数 方程 的 解 
无 论 是 利用 (2.27) 式 或 (2.29) 式 ,都 可 以 将 四 元 数 方程 写 
成 


一 = 了 2M*(oa)@(9) = 到 M(or)@(g) 


为 了 书写 方便 ， 引 入 符号 
0 ， 一 Op 一 0Oyp， 一 zxp 
Q=M*(Qg) = OuB» 0 ， zh 一 人 281 
OyE,s ~ Wzpy 0 ， OvE 


© 思 z 了 8 (人 DB， 一 OzBy 0 : 
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0 ,0 -Ory yl 一 Ozr 
[2 0 ~ Oz [0 
=M(@1)= ly 了 了 3 yi (2.114) 
- yr OOz7， 0 ， 一 Orzr 
Oozr，， 一 Or7， OzrIs 0 
铀 四 元 数 方程 可 写成 
.1 
4 一 五 29 . (2.115) 


这 是 一 阶 四 维 标量 微分 方程 ， 其 标量 之 间 满 足 正 交 关 系 式 
2 十 全 十 & 十 和 一 荆 (2.116) 


如 果 利用 一 阶 差分 法 解 标量 方程 时 ， 计 算 步 长 为 4x， 则 
ger drt SED rgr (2.117) 


式 中 Qi 一 (gogr1，gaxyls Qak+ 1 qax+1) (2.118) 
表示 在 tx; :瞬间 的 四 元 数 。 
如 果 利 用 四 阶 差分 龙 格 - 库 塔 法 计算 时 ， 则 


qxri 一 gx 十 言 ( 信 二 2 措 十 2 他 十 他 ) (2.119) 


种 
五 
A 


t 了 
AY = 和 o( tg 十 Aix)(ox 十 学 ) 
wm_ Atr Atx AY (2.120) 
名 = 和 9 (r+ 分 )(ex+ 每 ) 





、AW = (rt Atn) (qr + AY) 


与 递 推 法 不 同 ， 积 分 表示 法 的 近似 计算 和 差分 法 数值 积分 ， 都 
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不 能 保证 四 元 数 的 正规 性 ， 即 不 能 保证 NWN(q) =1， 为 了 能 在 所 
要 求 的 精度 范围 内 保持 正规 人 性， 对 计算 步 长 有 一 定 的 限制 ， 以 
一 阶 差分 计算 落 为 例 ， 设 在 如 瞬间 四 元 数 是 正规 的 ， 即 
qkgqx=1 
在 tx; 1 二 tx 十 4jr 有 瞬间 
Qk: 14k+1 一 =(gf+ Ssy KE 和 (er+ 人 wx 上 


< 


= Sr (qt Og t gorgn) + QO" Ogr 
-=1+ 2g 9 Qqx 
, A480 
改 qr 1gxr+1=1+ 4 (2.121) 
为 了 保持 正 交 性 ， 必 须 使 
gf+r19g+1=1 
即 要 求 
2 
全 woi<lo-* (2.122) 


?为 所 要 求 的 精度 指标 。 可 以 看 出 要求 的 精度 与 计算 步 长 有 
关 。 由 于 方程 计算 误差 和 舍 和 信 误差， 即使 采用 高 阶 差 分 数值 解 
法 ， 若 不 采取 特别 措施 ， 随 着 时 间 的 增加 , 正规 关系 式 g7*q==1 
的 关系 ， 将 不 再 成 立 。 为 此 在 进行 计算 时 ， 必 须 进行 范 数 修 
正 。 


$5 非 规范 化 四 元 数 方 程 及 范 数 的 自动 
修正 方法 
对 于 正 交 变换 的 四 元 数 范 数 
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qxg* =1 
这 个 联系 方程 是 由 正 交 变换 的 性 质 决定 的 ， 它 不 能 由 四 元 数 方 
程 本 身 得 到 。 因 为 


和 一 访 gyOz ， 《2.123) 


* 一 下 (gxa 和 一 五 Oxg* 一 一 Onng* 
， (2.124) 
如 果 以 os 左 乘 (2.123) 式 ， 以 4 布 乘 (2.124) 式 ， 然 后 相 雪 ， 则 
得 
g**g+ dx*g=0 


1 (gxg) 一 0 (2.125) 


wxxg 一 常数 
可 以 看 出 四 元 数 方程 ， 只 能 给 出 gxq* 一 入? 为 常数 。 并 不 要 求 
范 数 入? 一 1， 只 能 通过 起 始 条 件 的 确定 ， 来 满足 正 交 变换 的 要 
但 是 在 计算 过 程 中 ， 由 于 计算 误差 ， 如 果 不 采取 措施 ， 随 
着 时 间 增 加 ， 将 不 能 保证 范 数 为 1 的 条 件 ， 即 破坏 了 正 交 性 。 
扫 此 需要 对 范 数 进行 修正 。 下 面 研究 一 一 种 自动 修正 的 方法 。 
设 非 规范 四 元 数 9. 
gxg*= N 2 0 
将 9 规范 化 ， 用 #4 表示 规范 化 四 元 数 


IN9 . (2.126) 
没 扩 坟 标 系 变换 的 四 元 数 纲 足 方程 | 
¥ = (2.127) 
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微分 (2.126) 式 


§ =i9 (2.128) 


将 (2.128) 式 代入 (2.127) 式 ， 则 得 非 规范 四 元 数 9 的 方程 
4=R1+ ros (2.129) 


这 里 六 是 非 规范 化 四 元 数 9 的 范 数 的 变化 ， 可 理解 为 在 计算 过 
程 中 由 于 各 种 误差 的 影响 ， 而 引起 的 9 偏离 规范 值 。 它 是 时 间 
的 函数 ， 可 令 


N 

亢 二 J) (2.130) 
则 方程 (2.129) 变 为 

4 =f (Dg+ 3 gros (2,131) - 


这 里 f() 表 示 在 计算 过 程 中 ， 四 元 数 范 数 的 变化 特性 。 如 果 范 
数 变化 特性 已 知 ， 则 方程 (2.129) 与 方程 (2.27) 是 等 价 的 ， 因 
此 ， 不 论 范 数 的 数值 变化 特性 如 何 ， 方程 解 了 和 g 都 可 以 描述 
同一 坐标 变换 。 此 时 非 规 范 四 元 数 变 换 gx( )x#g~! 对 应 于 规范 
四 元 数 变 换 gx(。 )xg*. 

可 以 看 出 在 方程 中 附加 7(#)g 项 ， 不 改变 方程 的 物理 涵义 。 
.方程 (2.131) 和 方程 (2.27) 古 描述 同一 运动 的 运动 方程 ， 只 
是 用 (2.130) 式 夫 代 了 (2.125) 式 ， 而 对 #(D 是 没有 任何 限制 
的 。 由 (2.130) 式 ， 可 得 


WN (2.132) 
为 了 保持 四 元 数 方程 的 范 数 为 常数 (实际 上 ， 通过 起 始 条 件 的 


.选择 ， 范 数 为 1 ) 的 特性 ， 应 使 范 数 入 稳定 于 1 ， 
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利用 函数 了 () 形 式 选择 的 任意 性 ， 可 使 和 N= 二 1 的 点 成 为 方 
程 (2.132) 的 渐 近 稳定 的 平衡 位 置 。 例如 可 以 采取 如 下 几 种 形 


式 的 f(D). 
(1) f=K(1-N)， 则 


1— No -ui 四 
N | e - 


(2) f=- klnN, 则 
| N=exp[le-*‘lnNo] 
(3) f=—- KCN? -1)， 则 


N31 ml 
| / 
以 f = 天 (1- W ) 为 例 ， 如 果 用 一 阶 差分 解 (2.131) 式 ， 则 . 
gr =grt Mts| KG- wasx+ 二 ouaz| 
2 
NE =gke gen= (ot sts[ KC- Nar+ aio] 


-e+ 4t| KG 一 Nasx+ 二 9uax| 


—gkgr+ AxK(1-N )9g8gx 十 二 qk kgqr 


+ AtxK(1- N)ghqr t+ SQrge 


+ 全 [KG - Not 二 时 09 


-| Ka- Naax+ 二 egz] 
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= Ni%+2AtrK(1-— Nr) NE+ AlBK2(1-— N)?NE 
2 
+ Sgt 9 Qgx 


=NA{[1 +24tr KE (1 NET? + 1 tko8 } 


如 果 Ni>1， 则 NE NE<C1， 则 NE， 小， 故 稳 定 于 1 ， 


第 三 章 “四 元 数 在 刚体 运动 
控制 中 的 应 用 


$1 刚体 运动 的 妆 态 稳定 与 姿态 
控制 的 一 般 概念 


刚体 在 空间 运动 时 ， 经 常 会 遇 到 姿态 稳定 和 姿态 控 沸 问 
题 。 所 谓 姿态 稳定 是 指 刚体 在 运动 过 程 中 ， 将 刚体 某 一 轴 稳 定 
在 给 定 方 向 上 ;而 姿态 控制 则 是 将 刚体 从 现时 姿态 控制 转换 到 
某 一 给 定 方 向 或 给 定 姿态 上 去 。 前 者 称 为 定向 问题 ， 后 者 称 为 
定位 问题 。 例 如 天 体 物 理学 卫星 ， 卫 性 的 姿态 要 能 保证 星 上 的 
探测 器 (如 天 文 望远镜 ) 对 准 所 要 探测 的 星体 。 一 旦 对 准 之 . 
后 ， 就 要 以 所 给 定 的 精度 稳定 在 观测 方向 上 。 

无 论 是 姿态 稳定 还 是 姿态 控制 ， 在 刚体 上 都 应 有 姿态 稳定 
和 控制 系统 。 此 系统 应 包含 确定 刚体 相对 于 给 定 方位 或 给 定 坐 
标 系 的 姿态 角 ， 并 给 出 角 偏差 信号 的 姿态 角 传感器 ， 根 据 角 偏 
差 信号 形成 控制 信号 的 函数 转换 装置 ， 以 及 改变 刚体 姿态 角 的 
控制 执行 机 构 等 。 因 为 陀螺 装置 的 输出 是 欧 拉 角 或 其 函数 ， 传 
统 的 方法 是 用 欧 拉 角 或 其 函数 来 作为 角 偏差 信号 的 。 

但 在 捷 联 式 控制 系统 中 ， 利 用 计算 机 来 建立 基准 ， 其 输入 
信号 不 一 定 是 欧 拉 角 。 原 则 上 可 以 用 任何 运动 学 参数 来 作为 误 : 
差 信号 ， 四 元 数 是 最 方便 的 一 种 参数 。 
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刚体 姿态 稳定 与 控制 问题 可 以 看 成 是 体 坐 标 系 (国联 坐标 
系 ) 召 对 某 一 给 定 坐 标 系 工 的 变换 与 稳定 问题 。 

给 定 坐 标 系 有 时 被 称 为 基准 坐标 系 ， 通 常 有 两 种 情况 。 

(1) 基准 坐标 系 工 是 惯性 坐标 系 。 

(2) 基准 坐标 系 了 是 动 坐 标 系 ， 它 对 惯性 空间 进行 给 定 的 
旋转 。 

如 果 用 欧 拉 角 作为 控制 信号 , 设 坊 连坐 标 系 刀 为 of1y12,3 
基准 坐标 系 7 为 oz*y*z*， 两 坐标 系 关 系 , 由 三 个 欧 拉 角 4g， 
4%，4 来 确定 。 如 图 3.1I 所 示 。 为 了 将 坐标 系 oz gs; 转换 到 





图 3.1 固 连 毕 标 系 B 和 基准 坐标 系 1 关系 图 
03 85， 可 以 选择 -4 4》、- hs 4%、- A 作为 误差 信号 ， 
则 需 在 OCX*，oU ，0z :三 个 方向 进行 控制 才能 消除 误差 ， 而 控 
制 信号 往往 是 通过 作用 在 刚体 上 的 外 力矩 来 实现 的 。 在 外 力 抵 
作用 下 , 设 如 相对 于 了 的 旋转 角速度 为 @， 由 控制 而 产生 的 角 速 


度 为 4 四 、4 芝 、47， 则 
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w=Ap+AVY+Ay 和 (3.1) 


49 一 495zi 
4jj= 44% 二 一- 4gsin4p5 + AycosA9;; 
0 oz o 1 
Ay =Ayss*=ApcosApcosApsz, + AycosApsin A 55: 
— AysinAysz, 
(3.2) 


wy =ApcosAp + AvsinApcosAy (3.3) 


- = -AjsinAgp + AycosApsinAYy 
w= AB- ApsinAYy 


故 
2 一 oOs 十 (ozicos49 十 wysin4gp)tgAYy 
2 一 -ozisin4p 十 Oncos49 03.4) 


aAy _Ozicos4% + wysinAp : 
at cosAy 





解 (3.4) 式 ， 即 可 求 出 在 控制 过 程 中 4p 、4% 、4y 的 变化 ， 当 
49= 4= 少 =0 时 ， 姿 态 控制 结束 。 

由 图 3.1 可 以 看 出 ， 如 果 外 力矩 是 作用 在 oz*，08 02 :三 
个 方向 上 ， 则 不 会 产生 交 联 影响 。 在 外 力 算 作用 下 ， 欧 拉 角 迅 
速 豪 减 ,直至 两 坐标 系 重合 ,实际 上 外 力 算是 在 0X1,0Y1,021 方 
向 上 ， 则 产生 交 联 影响 。 例 如 在 og 方向 上 产生 力矩 ， 则 wu 变 
化 ， 不 仅 使 4y 减 小 ， 且 引起 4y、49 变 化 ， 引 起 了 交 联 。 所 以 
利用 欧 拉 角 4p 、4% 、 刀 作为 误差 信号 ， 存 在 控制 误差 稳定 性 . 
问题 。 已 经 证 明 ， 利 用 欧 拉 角 作为 误差 信号 是 渐 近 稳定 的 。 
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除 利用 欧 拉 角 作为 误 盖 信 号 外 ， 还 可 以 用 方向 余 继 来 作为 
控制 信号 ， 例 如 当 探 测 器 固 连 在 二 自由 度 支架 上 ， 如 图 3.2 所 
示 ，owi 为 探测 器 轴 ，ox* 为 需要 方向 ， 由 于 支架 是 二 自由 度 
的 ， 其 输出 信号 只 能 是 方向 余 藤 es ,加 和 es .il. 如 欲 得 到 方向 
余弦 el…i ， 则 需 在 另 一 轴 上 安装 相同 的 装置 。 当 探测 器 敏感 
轴 不 对 准 需 要 方向 o2* 时 ， 绕 oy , 轴 和 oz , 轴 旋 转 ， 给 出 相应 的 
信号 f1(es i,)、fs (es il)， 使 敏感 器 对 准 需 要 方向 。 因 为 一 
个 测量 装置 ， 不 能 给 出 绕 对 准 轴 的 角 偏 差分 量 ， 因 而 不 能 提供 
角 偏差 的 全 部 信息 ， 只 能 用 于 定向 问题 ， 如 果 需 要 定位 ， 则 需 
有 两 个 以 上 不 共 面 的 这 样 的 装置 。 





图 3.2 固 连 在 二 自由 度 陀螺 上 的 探测 器 示意 图 
如 果 用 el 、e> 、 es 表示 国 连 坐标 系 OZ18121 三 个 轴 向 的 单 
位 矢量 ,i 、i。、is 表示 需要 坐标 系 ozxgx#zx 三 个 轴 向 的 单位 
矢量 ， 则 其 方向 余弦 阵 
@1'b1, C2°b1s e3'ili. 
芝 ea 2 Bai2 


lv?a C2 1s，e3gs 
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gq?+qg?— aq3—98, 2(9192 二 9ogs)，2(919s 一 goga) 
=|2(g192 — qo09s), qt -gt +93 -43, 2(9293+q091) 
2(g19s + 9g0g2), 2(9293 — 4091), 43 一 0 一 人 十 和 


cos ApcosAy， cos ApsinAg , — sinAy 
sin dysin4bgceos4p sinAysinApsinAgp sinAycosAYy | 
一 | -sindysinAg, ”十 cosd4ycos4p ， 
cosAysinApcosAy$ cosAypsinApsinAp cosdycosAy 1 
| 十 Sin4ysin49p ，.: - sinAycosAg, J 
~ (3.5» 
如 果 取 方 向 余弦 
es by =cosAysinAp =2(g192 + gogs) 
-ea'ii=sinAy= - 2(919s 一 go9ga) (3.6) 
| es'is =—SinAycosA$—=2(92943 + god1) 


作为 控制 信号 ， 当 两 坐标 系 接 近 时 , A490, 49>0，Ay 六 03 
do >1， 4 >0，g>0，g9s0. 故 用 (3.6) 式 作为 控制 信号 ， 
当 误 差 量 很 小 时 

esii~Ap~2g0gs -earii~ 4 一 200g2 esi 到 4 一 29091 
(3.7) 
可 以 看 出 ， 当 误差 角 较 小 时 ， 利 用 欧 拉 角 ， 方 向 余弦 和 四 元 数 
”作为 误差 信号 ， 三 者 是 一 致 的 ， 且 知 g1 对 应 于 4y; 9s 对 应 于 
4%; 493 对 应 于 49， 


$ 2 四 元 数 在 定向 控制 中 的 应 用 


定向 问题 与 定位 何 题 不 同 ， 定 向 问题 不 需要 使 两 坐标 系 重 
合 ， 只 要 求 使 刚体 某 一 轴 指 向 某 一 给 定 方 向。 例如 要 求 卫星 土 
的 探测 器 敏感 轴 指 向 行星 、 太 阳 、 或 某 一 恒星 等 方向 。 ey 
只 要 求 两 个 控制 通道 。 我 们 知道 ， 资 态 控 制 系统 可 以 实现 三 
通道 的 控制 ， 因此 在 定向 控制 时 ， 可 以 附加 一 个 条 件 ， 来 滑 足 
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菜 些 特殊 的 要 求 ， “各 两 个 满足 基 附 加 条件 的 定向 控制 亲 
题 。 


一 、 全 二 内 过 生生 动迁 是 由 

为 了 使 研究 问题 简化 ， 设 需要 方向 对 惯性 空间 固定 ， 如 图 
3.3，ox* 为 需要 对 准 的 方向 ， 此 方向 对 惯性 空间 固定 。 如 果 
选择 固 连坐 标 系 051y121， .使 敏 感 轴 在 ox1 方 向 上 ， 则 控制 的 
目的 即 是 将 oz; 轴 转 至 oz* 方 向 。 





图 3.3 转动 角速度 最 小 的 定向 搁 章 示 总 图 
首先 研究 由 欧 拉 角 控制 的 情况 。 选 择 欧 拉 角 ， 先 绕 om , 轴 
转 44 角 ， 使 z1 转 至 由 om 和 ox* 所 确定 的 平面 ， 即 9z ， 再 绕 
08' 轴 转 4% 角 ， 将 ew , 转 至 og*， 此 时 ， .相对 转动 解 束 讼 介 是 
将 oz19121 转 至 oz*g'z* 的 转动 角速度 NL 和 A 利之 和 : 
加 R=Apyt+AY (3.8) 
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此 角速度 在 z:og' 平 面 内 ， 通 常 不 垂直 于 02*。 如 果 过 如 矢量 的 
端点 作 o%* 的 平行 线 ， 则 必 有 一 矢量 4 垂直 于 Oo”， 为 最 小 旋 
转速 度 ， 为 了 得 到 最 小 旋转 速度 4， 必 须 沿 -0oX* 方向 旋转 
Ay， 如 图 3.3 所 示 ， 此 时 相对 转动 角速度 
Q=An+AyY+Ay (3.9) 
央 为 当中 垂直 于 oX* 时 ， 需 要 转动 的 相对 角速度 最 小 ， 由 此 条 
件 可 以 确定 Ay 与 4 多 、4p 之 关系 ， 此 时 
(Aj+ AY+Ay).Ay=0 (3.10) 
即 (Ai .4y) + (0447y) 二 472 一 0 (3.11) 
人 | 
Ah= 475,= AncosAypos: + AjsinApsinAyos* 
+AzsinApcosAysz* 
Ay =Aps5' =AycosApyas:+ ApsinApsoz 
=AycosAyss* — AysinAyssz* 
Ay=Ap5z*=ApcosApsz + 47sin Apsin A155 
— AVpsinAycos A1az: 
(3.12) 
代入 (3.11) 式 ， 则 得 : 
ApApcosAp + AVAVsinAypsinAucosAp 
— Ay 4psinAgsinAncosAn + 472 一 0 
故 A7= - AjcosAy (3.13) 
设 相对 速度 名 在 oz :gz1 各 轴 上 分 量 为 如 rn， Bj、9a， 则 
{0.,.= Apsin’ Ay 
区 = AypcosAn - AjsinAycosApsinAL (3.14) 
:= Aysin A 十 4psin49%gcos4%eos44 
而 .92=4W%2+T4pzsinz4 坟 (3.15) 
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故 得 欧 拉 方程 
Ap = | 
A# = ,cosdnt Basindn (3.16) 
cosAy 
"sin? Ay 
如 果 22,、 人 2y:、 了 2z 已 知 ， 给 定 起 始 条 件 A1o、4Apo、4yo， 
积分 (3.16) 式 即 可 求 出 保证 转动 角速度 最 小 时 的 44、 44, 4y 的 
变化 。 
其 次 研究 用 四 元 数控 制 的 情况 。 设 将 0z1y1z1 转换 成 
oY 的 站 天数 为 4 ， 为 了 保证 旋转 角 严 度 最 小 ， 应 使 人 生 
直 于 oX*， 故 车 将 中 投影 在 oz*y*z* 上， 则 


A7=-8 


Qo* =0 . 
故 qi=0 i (3.17) 
G1=0 (3.18) 


让 sin 豆 ' 训 sin 可 








9, 六 9 
g"=(go,0,92,93) =( cos , 0, os 2 一 3 


四 元 数 方程 为 
$= ng (3.19) 

通常 将 如 投影 在 ox 1912 1 坐标 系 上 ， 则 

如 = 一 吉 (9nga + Qags) 

和 = Qng - Dags + Qug3) =0 


(3.20) 
ds = 元 (Qng 一 {21193) 





和 一半 (2sgo 十 《ciga ) 


74 
由 (3.20) 式 第 二 式 可 求 出 在 保证 旋转 角速度 最 小 情况 下 四 元 数 
与 所 选 欧 拉 角 之 间 的 关系 ， 此 时 ， 由 (3.20) 式 第 二 式 
Qado — 22g2 + (yga=0 i 
邯 go Apsin? Ay - go (AysinA1+ ApsinAycosAycosAn) 
+gqs(AypcosAn - AnsinAypcosAysinA4)=0 ‘(3.21) 
如 果 取 


qs =acosAy 、 - 
| ” (3.22) 
qs =asinAp : 
式 中 a 为 待定 系数 ， 则 
goSsinAy — acos Ay =0 
_», Sin4y 
歼 a do cosAy (3.23) 
”代入 (3.22) 式 ， 则 得 ; 
gs =qotgAycosAp 
qs =—gotgAypsinAy 
又 因 - q+ gt+g3=1 
故 
go =cosAy 
qi1=0 
! (3.24) 


dz 一 Sin 4 多 cos 44 
gs 一 Sin4%sin .44 


二 、 保 证 在 定向 过 程 中 不 绕 ox, 轴 滚动 的 定向 控制 


如 图 3.4 所 示 ，oX* 为 需要 对 准 的 方向 。 为 了 使 ow :指向 
oxx*， 并 保证 在 定向 过 程 中 不 绕 ow |, 轴 滚 动 。 这 样 来 选择 欧 拉 
角 ， 先 绕 02 1 轴 转 49g 角 ， 将 oX 1 转 至 由 021 与 0%* 所 确定 的 平 
面 内 ， 即 ow 

49 = 407， (3.25) 


?5 





图 3.4 不 绕 ow1 轴 滚动 的 定向 控制 示意 图 
骨 绕 og ' 轴 转 4% 角 ， 将 oz 转 至 ow* . 


A = 45) (3.26) 
此 时 ,已 将 ox, 转 至 o%*， 相 对 转动 角速度 
Q1=Ap+AY (3.27) 


此 相对 角速度 矢量 在 yozi 平 面 内 ， 通 常 不 委 直 于 om ，， 要 在 转 
动 过 程 中 不 绕 oz ;滚动 ， 即 2。 =0， 应 绕 owx 轴 转 作 角 . 


4y =47 5 (3.28) 
使 合成 角速度 外 在 goz; 平面 内 ， 则 如 垂直 于 ow , . 
QD=2+Ay=Agp+ AY+ Ay (3.29) 
z=ApcosAgpcosAy — Aysin4p=0 
Oy =AypsinAgpcosAy + AygcosAg (3.30) 


om =A49- 47sin 4 纱 
由 (3.30) 式 可 得 欧 拉 方 程 
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Ap= Qt+ QsinAgptgAy 


Ay= DycosAg 
(3.31) 


sinAg 
COS4 幼 


如 果 设 保证 不 绕 ox 滚动 ， 而 将 oz lgizi 转 至 ozxg*zx 的 四 
元 数 为 ， 则 因 


4 三 全 六 


| Qn=0 . (3.32) 
则 A1=0 (3.33) 
和 4 二 0 (3.34) 


a pb Qn Pb 0 ii 及 
= (No, 0， 12 四 43 ) = (ee 各， 0 sin 本 ,sin 5 $) 
四 元 数 方程 为 

和 = 二 4= 夺 2 (3.35) 


如 果 将 足 投影 在 oz;y:z1 坐 标 系 上 ， 则 
| ho 二 by (Duh 十 (zha) 
和 = Dah t+ Qn%s) =0 


(3.36) 
和 = 去 Qugo 





__1 
hs 一 可 22zigo 
.为 了 解 出 四 元 数 4 与 欧 拉 角 的 关系 ， 往往 利用 全 x 方程 ,此 时 


和 = 二 4 (3.37) 
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人 zx# 一 47 ~- ApsinAy 


Qo*=ApsinAycosAy + AycosAy . (3.38) 
ApoosAyeos dy - 4 人 
当 4: 一 0， 玫 1 二 0 时 : 
Goho t+ Doxhs — QDyxhs =0 (3.39) 


将 (3.38) 式 代入 (3.39) 式 ， 则 

ho (Ay — 49sin4%) + hs (ADecosAycosAy — AysinAy) 

- As(ApcosAycosAy — AycosAy)=0 (3.40) 
由 (3.30) 式 第 一 式 


-tgAp 
47 =t08 4y (3.41) 





代入 (3.40) 式 ， 则 


sinAgp 了 ) 
(5 c68384o ~ hasindy hscosdy 


士 48(- hsinAyp+ hscosApcosAy 
~ ?asindycos4%) =0 | (3.42) 


Sin 40 
cosApcosAy 


| hssinAy + hacosAy= 
‘hscosAycosAy ~ 4asinAycosAy = hosinAy 


sinAgpsinAy + cosApcosAysin.Ay ) 
牙 2 一 人 cosApcosAy 


二 一 (Ts 0 ) 
和 cosApcosAy 


(3.43) 
Xi 十 4 二 23 一 1 
ho=cosApcosAy 


和 六 


78 


故 知 在 无 滚动 情况 下 ， 四 元 数 和 欧 拉 角 关 系 为 
{ho =cosApcosAy 


%1=0 (3.44) 
hs 一 cosdpsin4%cos47? 十 sinApsin Ay 
4s=sinApcosAy — cosApsinAysinAy 


$ 3 对 惯性 空间 定位 控制 
的 稳定 性 问 是 


如 前 两 节 所 述 ， 无 论 是 姿态 稳定 还 是 姿态 控制 ， 少 必须 选 定 
误差 信号 及 其 控制 规律 。 与 欧 拉 角 一 样 ， 四 元 数 作为 误差 信号 
也 有 两 种 组 成 形式 ， 即 用 四 元 数 及 其 函数 作为 误差 信号 和 用 四 
元 数 表示 的 方向 余弦 及 其 函数 来 组 成 误差 信号 。 

用 欧 拉 角 作 为 控制 信号 的 控制 稳定 性 问题 ,已 经 得 到 证 骨 ， 
这 里 不 再 狐 述 。 利 用 四 元 数 作为 误差 信号 ， 也 窜 在 入 他称 定 入 
问题 ， 需 要 加 以 研究 。 

将 国 连 从 标 系 (05w921) 转换 到 避 性 仙 标 系 T(02*9*27) 
的 四 元 数 用 4 来 表示 , 则 2 与 第 二 章 §$2.2 节 中 的 四 元 数 g 相反 ， 
那里 的 9 是 表示 将 工 转换 到 妃 的 旋转 四 元 数 。 坐 标 系 妃 的 绝对 
角速度 为 纪 ， 它 是 根据 姿态 角 传 感 器 的 信号 所 形成 的 修正 角 束 
度 。 将 五 转 到 二, 故 四 元 数 方程 为 


= 2 = A (3.45) 


采用 将 角 涉 朗 投 影 到 因 连 坐标 的 方程 ， - 
2%0= — Xi Oa- he Dys -hs 2 
241= ho Qa- hs Qa t hs Qs 
2%2 = ho Dy th Das — hs dz, 
24s=h0 Qa- hi Qnt hs dr 


(3.46} 


y9 
对 两 种 组 成 信号 的 方法 ， 分 别 研究 定位 稳定 性 的 充分 条 件 。 


一 、 用 四 元 数 分 量 及 其 函数 组 成 误差 信号 
引入 辽 普 诺 夫 函数 
环 =1- 和 = 到 [CGI -328 二 和 3 十 2 十 3] (3.47) 


此 函数 当 召 、7 重合 时 为 零 ， 对 应 的 四 元 数 为 (1，0，0，0)， 妆 
互 、7 不 重合 时 为 正 ， 故 函数 三 是 正定 的 。 其 导数 
W= — 246% = hh Oot ho ha Dy + ho hs Dss 
(3.48) 
如 果 采 用 线性 修正 ， 则 取 
Qa= — Kisoh; Qy=- Ks ho ha 12 = - Koh, 
(3.49) 
当 民 ;六 0 时， 将 (3. 49) 式 代入 (3， 48) 式 ， 则 
市 = (kK, 844+ Ka AdA2 + Ke a348) (3.50) 
故 广 是 负 定 的 ， 由 辽 普 诸 夫 运动 稳定 性 定理 ， 系统 总 稳定 的 ， 
在 4 变化 的 整个 区 间 〈》。 #0) 浙 近 收敛 于 平衡 位 置 多 = (i, O05 
0, 0)。 
当 和 二 0 时 #| 仍 |=0， 访 变 为 零 , 是非 稳定 的 平衡 位 置 。 
因为 如 果 设 K;=K, (i=1,2,8)， 则 | 
W=— KI- 48)=- KW(I-W) 
—_-ki . ， 
故 WT ry (3.51) 
可 以 看 出 ， 对 于 初 值 矿 ,过 1 来 说 ， 在 玉 >0 时 ， 琴 (从 二 0， 甚 
收敛 速度 依赖 于 修正 系数 下 ， 显 然 ， 除 各 = 二 0 外 ， WW 者 不 能 是 
1 ， 而 当 歼 , = 1 时， W(t)=1. 
设 存在 一 无 穷 小 扰动 E ， 若 
‘W,=1- € 
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(1-— E€E)e-r: (1~— Ee 
出 WI EI Er Ej 
1-E | 1 


和 


TI E)+Eer 1+Eer 
当 t 罗 co 有 时 ， 琴 >0， 故 知 2o=0， 丈 ,=1 时 是 非 稳 定 结 点 。 
如 果 采 用 非 线 性 修正 ， 设 取 
有 = 一 一 玉 :7I(20)0(21) 
Qn= — KF,(ho)$: (4,) (3.52) 
Das= — KsFs(ho)Gs (hs) 


只 要 式 中 函数 (40) 和 (1) 满 足 条 件 
ho Fho) SO hpi(h)>0 (3.53) 

则 W=—- [KN NF (Nh) G1 (%1) 

+ K2 ho ha Pa (ho) pas) 

+ Kaho hsFs(ho)pa (hs)] 
当下 : 光 0 时 ， 在 给 定 条 件 (3.53) 时 ， 矿 是 负 定 的 ， 只 要 各 却 0， 
都 能 保证 控制 过 程 的 渐 近 稳定 性 。 当 和 = 二 0 时 ， 歼 ,= 二 1， 与 线 
性 修正 规律 一 样 ， 此 点 亦 是 非 稳 定 结 点 。 


二 、 用 四 元 数 所 表示 的 方向 余弦 进行 控制 
如 图 3.,5， 考 虑 到 (3.5) 式 ， 取 
Qa = ris)=— Ki ~ Mah) 


n= -eis)= 一 Ka(ho hs + hhh) 


人 >, 一 -es i)= 一 Ks(N hath NA,) 


(3.54) 
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图 3.5 “坐标 系 书 ,I 示 意图 
或 Qa (eis) = Kelh hs ~ 1h) 


(3.55) 
引入 辽 普 诺 夫 函数 
分 =ae(1- 和 和) 上 BA 二 2 二 23 (3.56) 
或 中 .6.6 是 任意 正 数 ,， 则 厂 是 正定 的 。 仅 在 平衡 位 置 (1， 
0, 0, 0) 变 为 零 。 
微分 (3.56) 式 ， 则 得 : 
WW= -20h0 ho +2Bhshs +t2yhs hs +2641A41 (3.57) 
由 (3.46) 式 ， 且 采用 线性 修正 (3.54) 式 ， 则 得 ， 
—-W=K,(o+06)42h2 + Ks (a ty) NBN 
+ KlatpB)ash3+ Ki(y— PB)N2N2 
+ Ks(6-B)AIA3E Ks(y— 60)N3h. 
+[K.(p-y-a-6)+ Ks(aty-pB+6) 
+ Ks(y-6rtatpB)] ho NA hs (3.58) 
式 中 “十 ”号 对 应 于 ,采用 (3.54) 式 ,“ 一 ”号 对 应 于 人 zw 采用 
(3.55) 式 。 可 以 看 出 ， 欲 使 广 是 负 函 数 ， 必 须 满 足 条 件 
Ki>0; y>p, 6>p, +(y -6)>0 (3.59) 
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. 武 中 符号 ( 士 ) 分 别 对 应 于 如 :所 选择 的 公式 。 
但 仅仅 满足 条 件 (3.59) ， 并 不 能 保证 在 4; 变化 的 整个 区 
间 ， 广 都 是 负 定 的 ， 下 面 我 们 将 证 明道 过 a、p、y,6 的 选择 ， 可 
使 下 在 4, 变 化 的 整个 区 间 是 负 定 的 。 
将 (3.58) 式 写成 
.一 让 =[ 民 :KaT6)28X3 二 Ki(v- BAN 
+aho dha Nhs] + [Ro (oaty) aN 
+ Ka(6— PB)AIN3+ Dh Ni ds] 
+[KsCatp)a3A3t Ks(y -723 和 
+cAo hhNa Nsl]. (3.60) 
式 中 atb+i+c=K.(p-y-a-d) 
+ KEK,.(a+y-p+6) 
本 + Ks(y-6ratp) (3.61) 
为 了 使 这 三 个 二 次 型 都 是 正定 的 ， 必 须 满足 条 件 
(42=4 开 (aa+6)(2 一 >a2 So 
[ee rnp (3.62) 
C=+4K3(a+p)(y -6)>e’>0 
式 中 42，B?，C? 都 是 实数 ， 故 
. 2 _ A<ach 
| (3.63) 
-CO<c<C 


如 果 以 a、.8、e 为 轴 ,. 则 (3.63) 式 为 一 长 方 体 ， 如 图 3.6 所 示 ， 在 
长 方 体内 任何 a、5、c 值 均 能 使 (3.62) 式 成 立 ， 考 虑 到 关系 式 
(3.61)8 作 平 面 
atbt+ce=K(p-y-a-6)+ K,(a+y+6- Bp) 
| + Ks(y-6-ta+tph)=d (3.64) 
与 长 方 体 相交 之 体内 蕉 平面 上 a、,5、c 均 满足 (3.62) 式 ， 即 是 
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3.6 满足 稳定 条 件 的 平面 示意 图 


-2Ks/(g+60)(y -pb) -2K,V/(at+y)(6- bp) 
-2Ks/+t(o+PB)(y -OE(P -yo -0) 
+ Ks(atryt+6-p)+ Ks(y-6tatp) 
<2KiV/ at (vy -B+2Ks /oaty) (6-8p) 
十 2 天 sw 士 (a+B)O -9 (3.65》 
由 (3.65) 式 可 得 ， 


-Kil(at+o6)+t+(y-p)-2v(o+6)(y-B)] 
+ Ka[l(at+y)+(6-B)T2V (tat) 0-8)] 
Ksl(at+p)+t(y-60)+2vV tat+p) -56)] 
>0 
Ki[(at+o) ry-B)+t2V ato (ypP)] 
-Ks[(aty)+(6-p)-2v (a+y)(6-P)] 
TKs[(at+p)+(y-6)T2V/ arp ty-6] 
>0 : : 





(3.66》 
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-Ki[Vatd -Mp-B]+ KVary + Vp la 
+tKs[lVat+B+t /iY-6]>0 
KilVa+d +My-B]:- KlVaty ~- VE-p)? 
TK [Vatpiv/iYy -61>0 
(3.67) 
如 果 选 择 w+6=y-p5 a+y=6-p， 这 与 条 件 (3.59) 是 不 矛 
盾 的 ， 此 时 由 (3.67) 式 第 一 式 得 ， 


[Vatp 土 ~V 士 (y- 人 50)]? 
kK, 守 于 Kk, a ty 


钼 (3.67) 式 第 二 个 不 等 式 得 ; 


Q 十 6 
kK,>K, [Va+p ne )]? 
式 中 ( 士 ) 符 号 ， 分 别 对 应 于 2。, 的 不 同 公式 。 
对 于 9s, 的 第 一 种 情况 ， 即 (3.68) 式 取 负 号 ，(3.69) 式 取 
正 号 ， 则 对 于 任何 正 数 下,。 、 下 ，。，(3， 68) 式 恒 成 立 。 对 (3.69) 
式 ， 如 果 能 选 出 6=w-+y- 8， 则 
> b>a (3.70) 
如 果 选 不 出 6 二 4 十 y~p， 则 仍 用 (3.69) 式 。 
对 于 2 的 第 二 种 情况 ， 即 (3.68) 式 取 正 号 ，(3.69) 式 取 
负 号 ， 则 对 于 任何 正 数 天 ，、 kK,, (3.69) 式 恒 成 立 。 对 (3.68) 
式 ， 如 果 能 选 出 6=a+y-p， 则 : 


2 2 
KR TM Pop (3.71) 


2 +y) 
否则 仍 用 (3. 68) 式 。 : 
(3470) 和 (3.71) 式 ， 给 出 了 大 !、K,，、 太 ;之 间 的 关系 。 


(3.68) 








(3.69) 
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可 以 看 出 ， 通 过 参数 a、 、6、y 的 选择 ， 总 能 使 (3.66) 式 成 
立 ， 即 下 是 负 定 的 ， 故 按 方向 余 续 控制 是 渐 近 稳定 的 6 
在 本 章 第 二 节 中 ， 我 们 说 过 ， 两 个 通道 的 控制 ， 就 能 完成 
定向 控制 ， 而 三 个 通道 的 控制 ， 才 能 完成 定位 控制 。 利 用 以 上 
研究 ， 可 以 证 明 这 个 问题 。 
以 按 四 元 数 分 量 (3.49) 式 进行 控制 为 例 。 
如 果 只 进行 单 通道 控制 ， 则 ,>0，K, = 二 下， 二 0， 则 辽 
普 诺 函 数 (3.47) 式 的 导数 
W=— KA2%N3 (3.72) 
当 加 =0 时 ， 矿 二 0， 显然 这 是 控制 消失 的 平衡 位 置 ， 也 即 是 说 
将 坐标 系 思 转换 到 坐标 系 1 的 有 限 转 动 和 拓 量 位 于 es es 平面 上 。 
运动 方程 (3.46) 的 解 ， 对 应 于 这 些 位 置 中 的 任 一 位 置 。 
如 果 进 行 两 个 通道 的 控制 ， 设 K,>0; K,>0; K,=0， 
则 
W=— (KANT+ KAM) (3.73) 
当 久 一 hs 二 0 时 ， 斑 =0， 相 当 于 有 限 转动 矢量 指向 es， 这 种 
位 置 中 的 任何 一 个 位 置 都 是 平衡 位 置 ， 不 能 达到 定位 的 目的 ， 
故 刚体 对 于 惯性 坐标 系 定位 ， 必 须 使 用 三 个 通道 控制 。 


$4 对 以 常 角速度 旋转 坐标 系 定位 
的 控制 稳定 性 问题 


除 对 惯性 坐标 系 定位 的 情况 外 ， 通 常 遇 到 的 是 对 旋转 坐标 
系 的 定位 。 在 卫星 定位 问题 中 ， 由 于 卫星 或 行星 (例如 地 球 ) 
通常 可 以 近似 看 成 是 以 等 角速度 在 轨道 平面 内 运动 。 不 失 一 般 
性 ， 设 o。 =wois， 即 需要 坐标 系 o0z*y*z* 沿 02* 方向 以 等 角 速 
度 oo 旋转。 设 坐 标 系 o8igiz: 的 修正 角速度 为 号 = 人 (如 2 09,,， 
9 )， 当 两 坐标 系 重合 时 , 必须 ' 使 坐标 系 0%1Y121 和 与 02*y*z* 
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网 样 旋转 ， 故 还 需 使 坐标 系 ox1g121 具有 附加 速度 ox* 一 oxes 
二 0O0es， 则 坐标 系 02 1.91z1 的 绝对 角速度 
D+O*=Boelt Qnest+ (Qator)es (3.74) 
由 图 3.7， 设 两 坐标 系 之 间 四 元 数 为 2 ， 


wo - £ a" : 
了 一 -一 一 一 人 加 他 站 到 二 世间 -人 OF1¥121 
Rt 
图 3.7 
划 和 一 可 jx( 加 二 os) -二 os 和 (3.75) 
即 [4o 
和 | 
4 
、 0 ， ， 一 好 3 一 fp 3 —- (1: + wo*) 
1 9% ， :0 , 5 4 十 O# ， — Dy 
2 Oy 2 《02+ 0*), 0 3» 22 


Qator, 9， ， -fa ， 0 
0, 0, .0 ~ wolfrho | | 
10 0, -eo 0 和 | (3.76) 
0,@, 0, 0lll4l ~ 
on O03: O03 011g, 
如 果 取 of 一 oo ， 则 ~ 
2%0 二 一 1 Qa hs Qs he Os, | 
加 24 一 加 ot ha 2- hs Ag 2 co (3.77) 
.4 ho Dy — hi rit hs fm ~ 24100 四 
92 


歼 
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当 修正 角速度 Qa 一 9 = 9-=0 时 ， 由 (3.77) 式 可 以 看 出 
2; 的 进 动情 襄 。 
此 时 Le ho (一 和 oo (3.78) 
4s=0, 23 (级 一 0so 
和 1 二 ho v0 《 
(3, 
人 本 
I Nzosinwoé (3.80) 


7 (#) 一 Az6CcOSOo0tt 十 Aiosinaot 


解 (3.80) 表 示 在 没有 修正 量 时 ， 坐 标 系 oz 19gizi 相 对 于 坐标 系 
ox*y*z* 运动 的 情况 ， 在 坐标 系 ozlgiz: 上 观察 ， 其 旋转 轴 在 


021 轴 有 上， 而 在 ox 
所 示 。 





图 3.8 两 坐标 系 相对 运动 情况 示 党 图 


当 @x* 关 wo 时 ， 如 果 z= 二 y= 二 2: 二 0， 则 


(ho = ho0 cos TF-(@* - wo)t+t hso sin5 (0o* - oo) 


1 
| 
| 
1 


了 





2 


2 一 2]s0 cos3 (0* — Wo )t+ Noo sin 二 (os — wo)¢ 
41 一 和 aocos 豆 (@x 十 Qo )t 十 haosinB (0* +wo)t 
LD > “ 


4 一 和 aocos 训 (ax 十 oo) 疆 Xiosin Co* + oo)t 


*gxzx 上 观察 , 其 旋转 轴 在 02* 轴 上 ,如 图 3.8 


(3.81) 
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两 坐标 系 相 对 运动 的 情况 与 图 3.8 相 类 似 。 

由 方程 (3.77) 可 以 看 出 ， 平 衡 位 置 (1，0，0，0) 是 方程 当 
9 二 0y = Qa 时 的 解 。 

在 姿态 修正 过 程 中 ， 如 果 选 择 wx ov, 可 以 证 明 按 四 元 数 
分 量 进行 控制 和 按 方向 余弦 进行 控制 都 能 实现 修正 过 程 的 渐 近 
收敛。 

与 对 惯性 坐标 系 定位 不 同 之 处 在 于 ， 对 以 常 角 速度 旋转 坐 
标 系 定位 ， 不 一 定 都 需要 三 个 独立 的 修正 信号 ， 以 下 分 别 来 进 
行 研究 。 


一 、 按 四 元 数 分 量 进行 控制 的 情况 
0， K,=0. 
仍 取 辽 普 诺 夫 函 数 
W=1- 各 二 二 [C1 一 48) 十 49 十 和 8 二 13] 
(3.82) 
其 导数 到 = 一 24040 ==40 和 4 605+ hha Oy 
十 hhs 62 (3.83) 
如 果 采 用 线性 修正 ， 取 
z= — KN Ni, y= ~ Ko ho ho, (z=0 
| (3.84) 
则 (3.83) 式 变 为 
- 瑟 = 开 2823 二 Ka NAN2 (3.85) 
除 和 41 二 1s 二 0 外 ， 市 总 是 负 的 。 故 斑 是 负 定 的 。 即 对 于 4,、 加 而 
言 是 稳定 的 ， 由 于 没有 涉及 到 4。， 需 要 研究 当 41= ?os 二 0 时 ， 
是 否 含 有 在 给 定 的 修正 规律 下 满足 方程 (3.77) 的 整 轨 线 。 
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设 方程 (3.79) 中 sz 二 05= 9a 二 0， 则 
0 二 0， 色 ;二 0， 义 1 二 4 0， = 二 一 100 ， 
显然 ， 对 于 4 三 4 一 0 来 说 ， 轨 线 40 0) 二 Xo，43(8) = 二 4so 满 
足 方程 。 存 在 整 轨 线 ， 就 是 说 ， 根 据 0,,. Qs, 两 信号 修正 的 
情况 下 ， 不 能 满足 渐 近 稳定 的 条 件 。 因 此 ， 利 用 这 两 个 信号 进 
行 定位 是 不 可 能 的 。 
” (2) 根据 @。，8。: 两 信号 进行 修正 ， 即 取 天 ， >o, K, = 


0, K:>0. 。 
仍 用 线性 修正 ， 取 ， 一 
Qo=— Khohis Dy=0; z= ~ KN hs 
(3.86) . 
则 —-W= EA Ke ABNs (3.87) 


除 2:=2s=0 外 ，b 总 是 负 的 ， 故 依 是 负 定 的 。 对 于 各、2 
言 是 稳定 的 。 由 于 没有 涉及 到 4, ， 需 要 研究 当 41 = 关 2s 关 0 时 ， 
是 否 含有 在 给 定 的 修正 规律 下 满足 方程 (3.77) 的 整 轨 线 。 
设 方程 (3.77) 中 人 2sn= By 二 zy 一 0， 则 
| 和 二 0， 外 3 二 0， 针 1 二 4p ， 2 = 二 一 100 
因 已 知 如 二 0， 玖 4, 必 为 零 。 故 除 平衡 位 置 4 二 0 (i 二 1,2, 3) 
外 ， 无 其 他 整 轨 线 满 足 方 程 (3.77)， 故 此 种 情况 定位 是 可 能 
的 。 
理 ， 利 用 @，，9。: 两 信号 进行 修正 也 是 可 能 的 。 
(3) 只 采用 一 个 修正 信号 | 
当 根 据 吕 >。 修正 时 ， 邵 K1 >0， 下 ;一 下 ,一 0。 对 于 集合 
2 一 0 来 说 〈 即 使 如 = 变 为 零 的 集合 ) ， 有 解 
20 一 2oog Nslt) ho 
故 定 位 是 不 可 能 的 。 
当 根 据 2;, 修 正 时 (Kl 二 0，K, >0, KK, 二 0) 与 上 面相 间 。 
当 根 据 62, 修 正 时 ( 芭 1 一 及; =0， 玉 8>>0)， 对 于 集合 和 4 三 
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、0 有 解 
[2 (#) = Mocoswot + hoosinoot 
Ma (£) = N20coswot + Niosinoot 
定位 也 是 不 可 能 的 ， 履 只 利用 一 个 修正 信号 进行 定位 是 不 可 能 
的 。. 
为 什么 在 对 等 速 旋转 坐标 系 定位 时 ， 可 以 只 采用 两 个 修正 


信号 (8:，8y: 修 正 除外 ) 呢 ? 下 面 近似 地 分 析 一 下 修正 过 
程 。 为 了 简化 ,假定 K;= K 


设 a= ~ KAAh!, D， =0, Os- Kh 


(3.88) 
则 (3.77) 式 变 为 
240= KA (CAI+ A = KA (1— 43— 23) 
24s=— Kho(hohs — NN) (3.89) 


24 1 二 一 KA CNN 二 hha) 200%2 
24。 一 一 2oo2， 
此 方程 描述 在 所 选 的 两 个 修正 信号 下 ， 将 oz :gzl 变 为 ozxg#z* 
的 转换 过 程 。 为 了 能 看 清 清 整 个 修正 过 程 ， 根据 ;变化 范围 分 三 
个 阶段 来 叙述 。 
(1) 设 初始 偏差 和 修正 系数 天 满足 
Quo zoo ( 即 K 光 @w0) (3.90) 
4: 和 4s 是 微量 不 满足 以 上 假设 的 情况 ， 将 在 后 面 讨论 。 此 时 
《3.89) 式 可 近似 写成 
240 = KA (1— hh2). 
24s= — KANoNs — NN ) 
24 1 二 一 KA (Ao + hs Ns) 
2%, =0 


(3.91) 


由 第 四 式 
- 4 (四 一 020 
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代入 第 一 式 
24。 = Kh (1- 43 一 23) 
(48)'= KA 48o) ~ 18] 
故 48(+) 
一 oo (1 ~ X30) 
Xio[1-e Oi] (1 42)e ROT) 
(3.92) 





由 第 二 、 三 式 
24s4s 一 一 KASAI+ K AohiNa hs 
2%141=— KXAN? Kho ANNs 


故 《43 十 28) 二 一 到 4823 十 2 和 ) 
= ~ KC M8) 一 (38 二 28) (4 十 和 8) 
和 (区 十 和 (的 四 
io 十 和 和 
了 工 一 ?3 


(3.93) 

可 以 看 出 ,过程 收 伍 的 快慢 和 初始 条 件 和 ,< 之 1 及 KK 有 关 。 当 
值 足够 大 时 

A LT1— 42 

A2(E) + 42 0 
它 描述 es 向 轴 记 的 转换 过 程 。 如 图 3， 9 所 示 。 

由 于 4,(#) = 420 

当 和 E( 芒 十 2 有 这 0 时 ，2 和 (人 二 21， 在 过 程 中 和 递增 ， 
因为 


一 cos2 
ho: cos 


232 





图 3.9 第 一 阶段 修正 过 程 示 意图 

0 为 绕 欧 拉 轴 的 转角 ， 故 转角 c (it) 从 初 值 wo 开始 减 小 。 这 表 
示 坐 标 系 oz :9gizi 已 从 开始 定向 的 位 置 绕 es* 轴 转 了 一 个 4c 角 。 
至 此 ， 第 一 个 快速 阶段 结束 。 

(2) 当 继 续 修正 运动 时 , 轴 e。 和 i 变 得 很 靠近 (如 图 3.9)， 
运动 将 是 坐标 系 oz 1912: 绕 轴 如 的 旋转 ，% ( 力 应 减 小 至 零 ， 使 
坐标 系 oz1g1z1 与 07*y*z* 重合 。 绕 轴 ? (ez ) 的 旋转 是 第 二 阶 
段 的 运动 。 为 了 近似 研究 这 一 阶段 的 运动 ， 设 方程 (3.89) 中 
办 0，4s0， 这 是 因为 4:(、24s ( 轨 由 于 修正 而 变 成 了 微 
量 。 这 个 微量 值 是 在 第 二 阶段 运动 中 所 要 保持 的 , 则 由 (3.89) 
式 第 二 式 





ha (3.94) 
0 
A 20 0a 
出 第 三 式 ]041 十 和 2 入 3 一 (3.95) 
并 和 0 
将 (3.94) 式 代入 (3.95) 式 ， 则 : 
一 2aoo A, _ 2@0 
和 ROT EK A2 (3.96) 


抹 4, 和 4 是 微量 , 故 4 二 如 =1~ 83~1.。 将 (3.96) 式 代入 


D3 
(3.89) 第 四 武 ， 则 


2 
有 4 _208$. . . _ 、 
故 Ma (有 一 Moe (3.97) 
式 中 ao 是 运动 第 二 阶段 的 起 始 值 。 此 时 
和 0 oe * (3.98) 
， i, 
h 2a, K . (3.99) 


此 式 描述 oz :gilzl 绕 轴 es (is ) 向 定位 位 置 的 转变 。 当 时 间 增 大 
时 ，2%1( 纺 sx X(t)、%s (2) 均 衰减 为 小 量 ， 可 以 看 出 修正 系数 
K 值 对 过 程 的 路 煞 速 度 起 相反 作用 ， 随 着 区 值 的 增 大 而 减 4 各。 
为 了 加 速 收敛 过 程 ， 可 以 引入 交叉 修正 信号 

人) 一 一 7022) (3.100) 
在 4， =4s 一 0 的 情况 下 ，》 4:、424: 是 一 阶 微量 ， 则 由 (3 . 77) 式 ， 
可 得 到 类 似 于 (3. 96) 式 的 结果 ， 而 (3.77) 式 第 三 式 变 为 


2 
2 和 =- (848 二 2o) 和 im - 22 200 )00 7, (3.101) 





和 一 1 人 一 (043 十 人 71 一 色色 
” ， 
和 (3.102) 
haoexp| 《有 十 200) oo 
2 (四 =- 一 一 一 








V + | - ae 中 
(3.103) 
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可 以 看 出 ， 引 入 交叉 修正 ， 可 以 大 大 加 速 收获 过 程 。 

(3) 在 分 量 4,(t) 变 成 微量 后 ， 近 似 解 (3.93)、(3.97)、 
《3.103) 式 都 失去 意义 。 当 4。 ，4?s 两 个 值 很 小 时 ， 平 衡 位 置 近 
旁 的 第 三 阶段 运动 , 由 线性 化 (3.89) 式 来 描述 , 略 去 方程 中 4、 
4。、%3(40 之 1) 的 二 阶 微量 ， 则 


_K ， 
2 和 4 一 -天 1， 入 一 和 0e (3.104) 
人 一 KA 斗 200o4， (3 105) 
2 和 一 ~ 200N 1 ” 


可 以 看 出 通道 和 s 与 通道 41、 和 无关， 面 2;、2* 通过 oo 互相 交 
联 。 :此 时 | - 


2 Kh 0th 0 
-St VE -og + os 
h(t) =Cune 和 16 “0 十 Coe 人 4 e 全 和 
-二 至-oi 0O3 ， 有 本 
| (一 Cae 4 e ae 4 
(3.106) . 


当 @6 与 比较 很 小 时 ， 收敛 过 程 的 时 间 很 长 。 为 使 收 伊 过 程 加 
快 ， 可 引入 交叉 修正 (3.100) 式 ， 此 时 
2 和 2 一 一 74 -20024， 





h(t) =Cue -人 1 AN 慌 -o (oo+3 3 


Kk 
owe 和 要 oes) ao 


可 以 通过 交叉 修正 系数 8 的 选择 来 加 速 收 和 敛 过 程 。 
(4) 最 后 研究 在 奇 点 jao 一 1 的 状态 
当 h0 = 1 时 |! 


四 
ha 一 98 可 十 2 Sin 


25 
如 图 3.10 所 示 , 由 方程 (3.89) 可 以 看 出 和 2 二 1， 和 = 二 41 二 4 二 0 
是 方程 的 特 解 。 在 此 位 置 上 ， 修正 信号 M1、 921 变 为 零 ， 是 
平衡 位 置 。 现在 需要 证 明 此 位 置 是 不 稳定 平衡 位 置 。 





图 3.10 奇 点 iao<:1 时 示意 图 
研究 此 点 近 旁 的 情况 。 设 在 方程 (3.77) 中 ，2。 ~:1，2，、 
21:、4s 均 是 微量 ， 此 时 只 =0， 方 程 变 为 
240 = -A Qs- ha hs, 
243 王 40 0 + Oz +200 
242 =ha Dz — hi zl- 24 10 
24s= 4 (1s, — Qs . 
因 GQ =- Khh, (z= — Kh Ns, 在 入 = 二 各 = 二 4 二 0 的 
点 上 变 为 零 。 在 其 邻 域 内 ， 略 去 三 阶 微量 ， 则 


(3.108) 


(24o=0 
2%s = Kh 21 43.109) 
241 一 一 起 02s 十 260 实 本 
> 24, = ~ 260 11 . 
改 No (t) = Noo (3.110) 


站 2 
和 + gh =0 


A1(t)= Ou cos TA tt Onsin— a 和 


(3.111) 
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是 一 保守 系统 ， 其 频率 er 








y? = (3.1127 
[和 
C= — 全 ho 十 加 han 《3.113)， 
代入 (3.109) 式 第 四 式 ， 积 分 之 
hs (£) = hh20 — Wo bs 二 LLSsin yt 一 acosyt ] 
一 220 — hiosinytt (时 2 一 2 人 an 20) 
‘(cosyt — 1) . 
— hoo (y? -ob ole 3cosyt) ， 二 和 ,EA (1 cow) 
— Mio sinyt | ” 和 (3 114) 


此 解 表明 ， 只 有 在 
1 ot 


时 ，4:() 才 会 接近 于 1 ， 即 使 在 小 放大 系数 的 情况 下 ， 只 要 
有 族 转 角 速 朗 oo 存 在 ， 就 会 使 系统 较 快 地 偏离 这 一 点 。 


二 、 按 方向 余弦 函数 的 形式 进行 控制 的 情况 


研究 三 通道 修正 的 情况 ， 与 (3.54) 和 (3.55) 趟 相似 ， 根 据 : 
e ， 了 两 坐标 系 之 闻 的 方向 余 粥 进行 控制 。 

引入 辽 普 诺 夫 函数 

W=a(l1 -A$)+BAS + yA + ON2 (3.115) . 
则 ”一 矿 二 一 2@4%0%o 十 2B4s%s 十 2 入 2 十 26 和 1 多， 
由 (3.77) 式 ， 且 采用 线性 修正 (3.54) 式 ， 则 得 ; 
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-~ =[K.(a+6)A8h3+ KI(B -yp) NN 
+EKi(y-o-pB-6)h0h1 Ns hs] 
+ [Ko(at+y) MAT+ Ks (p— 6)N3N3 
t+ EK,(at+pB+y- 6) A Ns] 
+[Ks(a+p)A343t Ks(6—y) NY 
土 K (6 -p+a+p) ho NN NA] 


— 2@0 (6—y)A1 A (3.116) 
起 中 “++ ”号 对 应 于 0z; 采用 (3.54) 式 ,“- ”号 对 应 于 Qs, 采用 
《3.55) 式 。 
设 选 择 6=y， 则 


- 信 =[ Ki(a+ OANA3+ Ki(B -yy) Nh3+aNoA Nhs] 
+ [Ka (aoty) NAS+ Ks (pp 一 56772828 
+ ONoNihahs] + KsCa+pB)N3N (3.117) 
起 中 a+b=《K,- KitKs)(o+p)=d (3.118) 
为 了 使 访 是 负 定 的 ， 必 须 满 足 
Ki>0 (i=1,2,3), p>y (或 B 之 6) (3.119) 
:由 (3.118) 式 ,为 了 使 二 次 型 是 正定 的 ， 必 须 
4Ki(at+y) (BP -ya 4K3(a+y)(p -y)>0? 
: | (3.120) 
即 人 人 2 eT PY 
‘~ 2K MV/(@+y) (Bp-y) SbE2 Koat+y) (Bp -y) 


| . (3.121) 
BR -2(K,+EK,)V(aty) (pb-y) 
AS2( K+ Ks) (G+y) (Pp-y) (3.122) 


Ka(Vaty +VB-y):- Ki(Vaty ~ VB-y)? 
士 下 s(a+B)>>0 上 - 
jj 下 (VS+7 +VB-y)- KA(Vary- vB-y)’ 
‘FEs(at+p)>0 | (3.123) 
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为 了 满足 (3.123) 式 ， 设 
| w 十 7 一 厅 -》 “2.124) 
则 由 (3.123) 式 第 一 式 


ot+p Ks 
Ki>Ksnti yy = (3.125) 


由 (3.123) 式 第 二 式 


K,>K, +h  - 


ks 
4(@+y) 2 


(3.126) 
以 上 不 等 式 ， 可 以 通过 选择 修正 系数 来 满足 ， 故 辽 普 诺 夫 函 数 
的 导数 是 负 定 的 ， 而 修正 过 程 是 浙 近 稳定 的 。 

与 (3.125) 式 相对 应 的 是 ， 控 制 中 使 用 is 的 两 个 方向 余弦 
进行 修正 ， 这 一 情况 决定 轴 es 同 轴 记 的 重合 过 程 ， 而 (3.126) 
式 则 对 应 于 用 计 的 两 个 方向 余弦 进行 修正 ， 决 定 e1 和 的 重合 
过 程 。 

与 惯性 空间 定位 相 比 ， 可 以 看 出 ， 由 于 坐标 系 02*y*z* 以 
常 值 wois 旋 转 ， 多 了 参数 a、.B、y 和 4 的 补充 条 件 ，6 一 J，& 二 
二 6 -y,， 由 此 导出 不 等 式 (3.125) 和 (3.126)。 | 

由 以 上 叙述 可 以 看 出 ， 当 控制 中 只 使 用 轴 训 的 两 个 方向 余 
” 续 时 ， 可 设 玫 ,=0. 此 时 ， 除 轴 e: 和 如 重合 所 对 应 的 位 置 外 ， 
辽 普 诺 夫 函 数 及 其 导数 为 定 号 的 全 部 条 件 都 保持 不 变 。 而 重合 
所 对 应 的 位 置 如 前 所 述 ， 它 不 是 运动 方程 (3.77) 的 整 轨 线 。 故 
知 ， 根 据 一 个 轴 i 记 (i 有 相同 结果 ) 的 两 个 方向 余弦 修正 时 ， 
在 旋转 坐标 系 中 ， 三 轴 定位 是 可 能 的 。 


$5 定位 的 动力 学 问题 ， 


我 们 把 误差 信号 直接 与 角 速 发 生 联系 的 控制 运动 稳定 性 问 
题 ， 浆 之 为 运动 学 稳定 性 。 实 际 误差 信号 是 加 在 刚体 的 外 力矩 
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上 ， 通过 力 拓 作用 族 变 刚体 旋转 角 沁 度 玉 实现 控制 的 。 因此 ， 
与 刚体 动力 学 联系 起 来 ， 我 们 要 研究 动力 学 的 稳定 问题 。 前 两 
节 所 研究 的 运动 学 稳定 条 件 ， 对 于 动力 学 稳定 来 说 ， 也 是 稳定 
的 必要 条 件 。 基 附加 的 条 件 是 需要 考 虚 阻 尼 力 和 矩 的 影响 。 
以 线性 修正 规律 作为 控制 函数 的 动力 学 控制 为 例 ， 刚 体 欧 
拉 方 程 为 
Tos t+ Tz- Ty) Wy My, 
[te | (3.127) 
Tz t (Ty -To) ormy = M,, 
式 中 壮 :,、 履 j,、 必 ;为 控制 力矩 。 如 果 采 用 线性 修正 规律 , 设 


Mz= -hws — KNoNi 
pr 402。 (3.128) 
Ms = -hw — Ks%h Ns 

作 辽 普 诺 夫 函 数 


T=V+W (3.129) 

这 里 。 琴 =1-38= 于 [CI- 238) 十 2 二 48 十 9 
(3.130) 
V = os 十 7 外 十 Ta3) (3.131) 


是 刚体 的 动能 。 

显然 ， 函 数 允 是 正定 的 。 而 且 在 相对 于 惯性 空间 定位 的 位 
置 上 为 零 。 即 

om 一 Oo 二 0z 一 0，00 一 1，2: 一 2 一 2 一 0 
辽 普 诺 夫 函 数 的 导数 

P=To0r Ms +t Tyo My tT M,, 
+ dohiQsit hohzy + Mohazs (3.132) 

将 (3.128) 式 代入 上 式 ， 则 
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让 = 一 772 02， 一 hsTyiw?, 一 天 37 .02， 
一 MAiwz (EK Ts 一 1) 
— hhzwyi( KE,T,, -1) 





— Moha®zs( KsTs, — 1) (3.133) 
-如果 选 择 | 
[全 1 一 1, 2, 3 
1 1 
KE,=—=- ， 一 一 一 
1 Is, 3 KK， LT, » Kk, Ts 


则 外 是 负 定 的 ， 按 (3.128) 式 控制 是 稳定 的 ， 当 然 (3.135) 式 是 
一 种 特殊 情况 ,实际 上 ， 只 要 能 保证 
一 A hwzri CK Ts 一 1) 一 Au hwy Kol,y, -1) 
一 Mo hs@zl EK als ~ 1) 
是 负 定 的 ， 则 少 即 是 负 定 的 。 
如 果 将 (3.128) 式 写成 
,Ms, = -h(a - 和)= -Co — Kr 1) 
一 一 pr(oc 一 £2) 


天 ?oj)= -js Co — KIA hs) 


= ~h, (yi 一 291) 


Ma = -hs(0n -天 jj)= -和 (os ~ KSho%s) 
3 


一 — hs (wz 一 L221) 


M,, = -bh (ou 一 





(3.134) 
式 中 介 z,、y,、 人 zi 为 运动 学 修正 角速度 。 如 果 通 过 KK1 的 选 
择 , 已 经 保证 了 态 是 负 定 的 ， 则 只 需 保证 
V= -Tornbhi(0s — Qa) -Tonho (on — 0g) 
— Tz0zha (Wz — 921) (3.135) 
是 负 定 的 ， 辽 普 诺 夫 函 数 小 即 是 负 定 的 。 
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(3.135) 式 在 |@s| 之 | 90; orn] 之 | 951,16::| 关 18;,| 
时 ,总 是 负 的 。 反 之 , 则 是 正 的 。 由 此 可 见 ， 利 用 (3.134) 式 进 
行 控制 ， 当 角速度 较 大 有 时， 将 刚体 动能 减 小 到 与 om = Qs,、 
Oy = ys oz 二 人 =: 相对 应 的 数值 而 当 角速度 较 小 时 ， 则 
增 大 动能 。 所 以 ， 控制 (3. 134) 式 力求 将 运动 变 成 角速度 为 中 
的 旋转 。 

考虑 到 83 的 条 件 (3.53) 式 ， 可 以 将 控制 东 娄 写 号 成 更 一 般 欧 
形式 ， 即 


Mz=— Fi(w— Q2) 
| Fs, (Oy -00y) 
Mz = -Fs(wz— 1:,) 
式 中 梭 属 于 (3.53) 式 所 给 定 的 锁 数 类 。 


$6 刚体 姿态 运动 学 的 最 优 控 制 

“以 上 儿 节 研究 了 姿态 控制 的 稳定 性 问题 。 可 以 看 出 ， 无论 
是 利用 四 元 数 分 量 作为 控制 信号 ， 还 是 利用 四 元 数 分 量 所 表示 
的 方向 余弦 作为 控制 信号 ， 通 过 参数 选择 ， 都 可 以 保证 控制 的 
稳定 性 。 现 来 研究 在 保证 稳定 性 条 件 下 ， 如 何 实现 最 优 控制 。 

首先 研究 运动 学 的 最 优 控制 。 所 谓 运动 学 的 最 优 控制 是 指 
用 角速度 作为 控制 函数 。 将 刚体 从 一 种 姿态 转变 到 另 一 种 姿 坊 
时 ， 能 满足 某 些 最 优 性 能 指标 。 本 节 研 究 最 速 转动 问题 。 此 时 
最 优 性 能 指标 是 使 

7T=| d=7 -4 (3.136) 

最 小 oi 

设 体 坐标 系 oz yiz; 相 对 于 需要 丛 标 系 ozxgxzx 的 相对 转动 
角速度 为 号 ， 其 在 体 坐 标 系 各 轴 上 的 分 量 为 2,、9:、D，， 
且 @xG=1,2,3) 属 于 有 界 闭 集 局 ， 其 转换 四 元 数 为 4 ， 则 
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和 = 二 全 1 和 (3.137) 
其 标量 形式 的 方程 为 
2 和 一 -00-220 -7290， 
24 1 =46 D1- As th 
"12%, =% Qo ths -hs Dl 
243=A40 Qs — hi Qs +t ha 11 
当 #= 如 时 (8) 一 2 | 
一 人 时 A(T)=hr 
设 共 罗 变 量 为 ， 和 明天 原理， 对 最 转动 其 哈 
密 顿 函数 为 
到 一 到 和 十 到 1 十 于是 到 2 (3.139)- 
共 辊 变量 ;(i 二 0， 1, 2, 3)， 满足 正则 方程 _ 
3 


(3.138) 


aE ~ a : . (3.140) 


其 标量 方程 为 ， 
2 ,=D -VQ -PQs 
[2w ,= 21 -FQ + 
2, 一 Vo D+ Qs -Ys QQ 
2 = Qs ¥1Q2 ty 0 | 
由 极 大 原理 ， 当 最 优 控制 时 ， 函数 % 在 D 上 达 极 大 值 。 
maxae [4*(&), w(t), Q(t)]1 


(3.141) 





=a0* [A*(6), x(t), QI(6)] (3.142) 

式 中 1(G0) 是 最 优 控制 ，Mx (为 由 只;( 轨 所 确定 的 最 优 轨 线 。 
联 立 (3.138J)、(33:141) 和 (3.142) 式 ， 共 8 个 微分 方程 和 
三 个 极 值 条 件 ， 利 用 8 个 边界 条 件 解 之 ， 即 可 确定 最 优 控 制 
Q4(t)， 这 是 典型 的 两 点 边 值 问题 ;出 于 是 变 系数 微 分 方程 ， 
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解 起 来 非常 复杂 ， 只 能 用 数值 积分 法 。 

但 比较 (3.138) 和 (3.141) 式 ， 可 以 看 出 ， 两 方程 组 是 完全 
相同 和 的, 故 方 程 组 是 自 共 圈 的 。 二 入 程 组 的 解 内 相差 一 带 值 
四 元 数 ， 如 果 令 


DV= AxOg : : 
则 i Cs 一 人 xx 友 | (3.143) 
因 208 一 2 和 xx 十 243x 由 
一 一 YX xx 十 AXxg2 0 =0 
帮 Cs 为 常 值 四 元 数 。 


将 (3 138) 式 代入 (3. 139) 式 ， 则 


ze = 于 中， (到 2。- 色 ,14h %3) . 


vv 


TQ h -Pah -Bo hatiNs) 


+ 二 (Wa + PA PiA, Wo Ns) 


"(3.144).. 
引入 矢量 函数 Pa(t)， 称 之 为 共 示 矢量 ， 其 分 量 为 - 
Pigs=B ho — Woh + Ph, r,s 
Pan = ho -Wahi— ods + A (3.145》 
Pas= Waho + Pahi~p i Nh Dh 


" -1(0, Ps Os Pas+ 0 :Paz) = 地 2 ‘Pg . 


(3.146) 
南极 大 原理 ， 抽风 必 本 和 全 只要 大 。 版 近 抽 
矢量 全 : 必 与 共 印 矢量 Pe 共 绩 。 即 应 油 足 
‘R=hPps . (3.147) 
式 中 亡 为 雍 全 系数。 在 有 界 半 集 DD 上 时 
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[2l'=01+ Qt O08 i 
旋 PP | 和 3148) 
.研究 共 人 矢 量 PECO.. 也 (3. 145) 式 可 以 看 出 Pa 从 由 罗 ; 和 
来 确定 ， 而 到 ;( 轨 可 以 用 (来 表示 。 故 Psz (人 菇 可 以 表示 为 
41(#) 的 函数 。 (3 145) 式 


=Vect(VxA*) (3.149) ， 
而 yx AxO nN* 
Scal(Wxh*)=Scal( hxO xh*)—= Seall PbOa) 
一 ScalCzr (3.150) 


由 于 共 轿 方程 组 的 齐 次 性 ， 可 选择 罗 的 范 数 为 1 ， 出 
Jwxa*l=|AxCzx4*)=1Csl= Iwila*|=1 
故 0s 的 范 数 也 等 于 1 。 则 
Vect(WxA*)—BxA*— Scal(VxNh*) 
7 =AxOgpxh*— ScalOsg 
一 和 (Or 一 SC 二 AxC pxh* 


(3.151) 

改 得 决定 共 元 矢量 的 基本 关系 式 
Pa = hx 0 px :~ C3. 152) 

代入 (3.148) 式 ， 则 得 最 优 控 制 
1 = Bo NO ph ， (3. 153) 


还 必须 指出 的 是 ; 四 元 数 2 是 刚体 位 置 的 双 函 数 〈 即 2 和 
- 4 恒 等 于 一 个 位 置 ) ， 由 (3.141) 式 ， 四 元 数 到 也 可 以 是 双 
值 的 。 故 知 Pe 和 Cs 一 样 ， 也 应 读 是 双 值 的 。 就 是 说 ， 同 时 满 
足 最 优 问 题 的 两 个 值 Cs 和 -Cs 可 能 存在 。 由 (3.153) 式 92 1 的 
不 同 符号 ， 也 即 是 不 同 的 旋转 方向 对 应 于 Cs 的 两 种 符号 。 这 
两 个 解 都 满足 最 优 条 件 ， 并 分 别 给 出 角 度 为 只 o( 卫 -加 ) 三 a 或 
2o( 了 -加 ) 一 25 -4 的 转动 。 两 个 解 中 只 有 一 个 满足 最 速 转动 
条 件 (a==z 除 外 ) 。 据 此 ， 对 于 最 速 转动 来 说 ， 应 满足 直列 条 件 
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oT ~ to) EA (3.154) 
进一步 简化 (3.153) 式 。 因 此 时 
2 和 二 如 1# 久 二 QohxC p¥ NxN = 9oMxCe (3.155》 
因为 QoCs 是 常 值 失 量 ， 则 


20) = horexp (3B QoCat) (3.156)， 
当 #==T 时 ，%(T) 二 hy 

hr hrexp( QoCe7) (3.157) 
故 exp( 寺 2oCez )= jseaa (3.158) 


因 Cs 是 单位 矢量 ， 故 

MiorMr=oos( 寺 oz )+Crsin( 寺 Coz ) (3.159》 
故 Ce] (3.160) 
代入 (3.156) 式 ， 得 最 优 轨 线 。 


406) = oo oo 90)+ rcos( 计 oT) Ge . 


sn(¥007 ) 


cos( 二 0 全 








一 和 cos( #904)- J (961) 


sin (二 oT ) 





+ sin( 吉 9 
sin( 卫 Oo7) 





(3.161) 
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此 时 最 优 控制 函数 
Q(t) or” -eos( 寺 007 )] 
(3.162) 
因 


PE | 5 exp( 二 oj 
0 


*[exp( -Qot *27,|= nA 


《3.163) 
故 最 后 得 最 优 控制 表达 式 
(3.164) 


良 此 ， 以 最 大 可 能 的 常 值 角速度 (3.164) 式 进行 平面 转动 是 最 
速 转动 。 而 由 (3.161) 式 确定 的 4( 四 是 最 优 轨 线 。 . 
由 (3.164) 式 可 以 看 出 ， 当 7 确 窗 后 ,cos (站 Qo。7 ) 为 党 


数 ， 则 景 优 控制 全 1() 只 取决 于 起 始 瞬间 和 终端 时 间 的 四 元 
数 。 如 图 3.11, ,表示 将 基准 了 变 
为 ,的 变换 四 元 数 。47 表 示 将 基准 
I 变 为 z 的 变换 四 元 数 , 而 将 。 变 
换 为 rz 的 误差 四 元 数 为 4， 则 
AxNio = Nr 
改 4 一 Arx4i。 《3.165) 图 3.11 基准 I 和 6,B7 
故 利 用 关系 示意 图 
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一 人 0 2 | 、 
2 Sign4。 (i=1,2,3) (3.166) 


来 作为 角速度 修正 信号 是 最 佳 控 制 。 利 用 (3.49) 式 进行 控制 近 
似 于 最 优 控 制 。 


$ 7 刚体 效 态 动力 学 的 最 优 控制 
运动 学 的 最 优 控制 是 使 修正 角速度 直接 与 误差 信号 发 生 联 

系 。 前 言 已 经 说 过 ， 实际 上 误差 信号 是 加 在 刚体 的 外 力矩 上 ， 
通过 力矩 作用 改变 刚体 旋转 角速度 来 实现 控制 的 。 因此 ， 在 研 . 
究 刚体 姿态 动力 学 的 最 优 控制 时 ， 首先 要 引入 刚体 的 力 和 什 方 程 

Ts Oz 十 (Ts, 一 T,,) Oy ms =M,, 

Ty (Ts ~ za)» 0s = M,, (3.167) 

Tz + (15 一 Tz) Ory =M,, 


式 中 力 和 给 有 {Ws,，M,,，M。,} 是 有 界 的 。 属 于 蘑 一 闭 域 禾 . 
设 将 体 坐 标 系 oz gz1 转 换 成 需要 坐标 系 ozxgxzx 的 变换 四 
元 数 为 4， 如 果 设 oz*y*z* 为 惯性 坐标 系 ， 则 
24 二 0 4x1 (3.168) 


起 始 条 件 : 1 一 加 时 h(to) =%,,, 1(t) = 
终端 条 件 ; t=T 时 4(7)=%z, @(T)=@s=0 
方程 (3.167) 和 (3.168) 为 状态 方程 ， 包含 om ，on ，a。 ， 
20o，41，2X。， 4s 等 七 个 状态 变量 ， 其 中 信 ,,、 衣 ,,、 肝 ,为 控 
制 变量 ， 由 最 优 控制 条 件 来 确定 。 研究 两 种 最 优 性 能 指标 。 
(1) 最 速 转 动 ， 即 要 求 转动 时 间 中 最小， 其 性 能 指标 为 


T 
7=|[ lt 一 -加 最 小 (3.169) 


设 对 应 于 角速度 wo。、 ys @z1 的 共 轿 变量 为 p9。、 Py, Das 
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对 应 于 和、 入 1、4%2、 和 4 的 共 轿 变 量 为 罗 。、 罗 1、 罗 。、 罗 8， 则 
哈密 顿 函 数 


B=<p, OV, h>=aat ey 


4 > z1 一 
=9:( ， Ta 一刀 onon ) 





Tz 2Z1 
十 py (2 一 二 Ls Wrz ) 
、 yi yl 
M.,, Ty, 1T;, ) 
Tp2 ( L, PE 人 


. (3.170) 
式 中 es 为 哈密 顿 函 数 动力 学 部 分 ，sex 为 哈密 顿 函数 运动 学 部 
分 。 





zx 一 二 om( 到 1 -DA 一 到 2 43) 
十 到 om(s ho -到 shi Wo N+P1Ns) 
ER LA -hs)- 
十 于 (ozPiz 十 omPaz 十 ozaPan) (3.171) 
由 正则 方程 知 
， _ Oy 
(3.172) 
_ Os: 
Pi 0 











1935 一 py 人 Oos 十 0 Lo 一 7z Dig 
| y1 Z1 2 
] Py—= ps a zi Pz Ls zl 一 于 Pa 
| Be, 1 了 Ts: 为 1 
\ Dz 一 和 zx Is, y Oyi 十 WE om 至 TPss 
(3.173). 


2 = -Vw -VT, Oy — Oz 

2 = Vat Ew | 

2 = Vt V0 ~ V3, 

2 = -TOP ws, 
由 庞 特 里 亚 金 极 大 原理 知 最 优 控制 必要 条 件 是 控制 变量 2 、 
取 ，、 2 在 允许 控制 集合 到 中 使 哈密 顿 函 数 达到 最 大 值 ， 即 


maxa (©1, 4, p, V, Mg) 一 ax#(O1 4,9, PT, ME) 
MgEM 


(3.174) 


| 1 (3.175) 
” 联 立 状态 方程 (3.167) 、(3.168) 和 共 思 方 程 (3.173)、(3.174) 
共 14 个 方程 ， 包含 oa，on Ori Nos hi ho hs, Pos 
Dy， Bz， Po， ，%ga ，g%s 等 14 个 未 知 数 ， 其 中 控制 变量 M。、 
Mov， 对 =: 由 必要 条 件 (3.175) 式 确定 。 已 知 14 个 边界 条 件 2、 
@o hr、oz。， 解 之 ， 即 可 求 出 最 优 控制 。 这 是 典型 的 两 点 边 值 
问题 ， 计 算 起 来 是 非常 复杂 的 。 这 里 不 再 叙述 。 
(2) 能 量 消 耗 最 小 ， 即 当时 间 7 固定 时 ， 要 求 


1 


fr ps | |M,, | ls 
G | (Ft) (3.176) 


值 最 小 。 
此 时 ， 需 在 状态 方程 中 补充 方程 


FT10O 


1 yl 1 


了 


如 果 设 其 共 罗 变 量 为 g ， 则 哈 窗 最 函数 为 





a=wat mrtg( LHe [+ lM | [Ms 上 (3.178) 
Ts, I Ts 





~ ” 
中 )- -各 -。 | (3.179) 
此 时 性 能 指标 可 写 为 
7 


， 1 (3.180) 
起 始 条 件 : 1 一 加 时 G=0. . 


终端 横 蕉 条 件 ，9(2) 一 -25 人 | 一 -1 


人 





将 方程 (3.177) 和 (3.179) 补 充 在 方程 组 中 ， 共 16 个 方程 ， 有 16 


个 边界 条 件 ， 解 之 ， 即 可 求 出 能 景 消耗 最 小 的 最 优 控制 。 
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”第 四 章 。 航天 飞行 器 姿态 
” “控制 的 四 元 数 法 


31， 航天 飞行 器 资 态 稳定 与 姿态 控制 

密 态 稳定 和 姿态 控制 是 航天 飞行 器 的 重要 课题 。 为 了 实 魂 
轨道 控制 ， 完 成 飞行 器 各 项 飞行 任务 ， 都 要 通过 控制 飞行 器 的 
姿态 来 实现 。 

在 航天 飞行 器 发 射 后 的 上 升 和 人 轨 段 ， 首 先 要 通过 姿态 控制 
系统 保持 飞行 器 的 三 轴 稳定 ;然后 利用 俯仰 角 和 偏 航 角 的 改变 
来 实现 程序 飞行 。 当 人 雪 前 进行 闭路 制导 时 ， 姿 态 控制 系统 根 
据 制 导 规律 所 要 求 的 发 动机 推力 方向 对 飞行 器 姿态 进行 控制 ， 
予以 实现 。 

在 轨道 运行 眉 ， 根 据 飞 行 器 的 飞行 任务 ， 对 姿态 有 不 同 的 
要 求 。 如 果 飞 行 器 是 人 店 卫 星 或 空间 站 ， 则 入 轨 后 往往 需要 将 
飞行 器 姿态 稳定 在 某 一 方向 上 。 例 如 侦察 卫星 在 飞行 过 程 中 
要 求 其 探测 轴 对 淮 地 球 ， 天 体 观测 卫星 要 求 其 观测 轴 对 准 欲 测 
星体 ， 如 果 航 天 飞行 器 是 作为 天 地 往返 运输 工具 ， 为 空间 站 运 
送 人 员 和 物资 ， 则 需 与 空间 站 进行 交会 、 对 接 ; 均 需 要 进行 一 
联 申 的 姿态 控制 。 前 者 是 姿态 稳定 问题 , 后 者 是 姿态 控制 问 
题 。 

卫星 和 空间 站 姿态 稳定 的 特点 是 ， 往 往 要 求 控制 系统 在 飞 
行 器 整个 工作 寿命 中 进行 控制 ; 这 种 控制 是 长 期 而 持续 的 ， 但 
要 求 的 控制 力矩 较 小 。 对 类 多 数 卫 星 来 说 ,通常 洒 用 次 首 旋 稳 
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定 系 统 ， 利 用 飞轮 角 动 量 矢量 的 改变 来 控制 星体 的 角 动 量 ， 并 
利用 环境 力 答 (重力 梯度 力矩 ， 地磁 力矩 等 ) 对 飞轮 进行 印 
载 。 
姿态 控制 一 般 是 短暂 的 过 程 ， 其 所 要 求 的 力矩 较 大 。 当 然 
我 们 可 以 利用 震 然 沫 境 的 物理 力矩 源 , 如 重力 梯 人 将 力矩 .地 磁力 
和 扎 、 气 动力 力 移 、 太 阳光 压 力 抵 等 进行 姿态 控制 。 但 这 些 量 都 
是 小 量 ， 对 于 在 短暂 时 间 内 需要 作 大 的 上 姿 态 变换 来 说 是 不 适用 
的 。 通 常 需要 利用 安装 在 飞行 器 上 的 喷嘴 控制 系统 来 进行 控 
制 。 以 “阿波 罗 ” 飞船 为 例 ， 其 喷嘴 在 飞行 器 下 的 布置 示意 图 如 
图 4.1 所 示 。16 个 喷嘴 分 布 在 星体 质心 的 四 周 。 当 其 中 某 一 喷 


?| 





主 发 动机 


图 4d.1 喷嘴 在 星体 上 布置 示意 图 
器 工作 时 ， 产生 推力 ， 对 星体 产生 力矩 以 改变 星体 姿态 。 其 推力 
作用 方向 示意 图 如 图 4.2 所 示 。 图 中 oz 和 hzi 为 体 坐标 系 ，9 为 


J1F 





图 4.2 喷嘴 推力 方向 示意 图 


质心 ，o2 :为 星体 纵 轴 。16 个 喷嘴 布置 在 cg:z: 平 面 内 ， 图 中 箭 : 
头 方 向 表示 歼 嘴 的 推力 方向 ， 则 此 16 个 喷嘴 按 其 作用 来 说 ， 可 
以 分 成 两 组 。 

(1) 产生 深 动 力矩 及 ,和 法 向 力 Z1、Y1 的 喷嘴 是 ，3, 4， 
7,8,11, 12,15,16. 

(2) 产生 绕 oy, 和 0z1 轴 的 转动 力矩 用。,、 有 以 ,, 和 轴 向 力 
和 ,的 喷嘴 是 : 1, 2, 5, 6,9, 10, 13, 14. 
由 图 4.2 可 以 看 出 ,喷嘴 在 这 样 的 布置 下 ， 有 如 下 的 特点 ， 当 
一 个 喷嘴 工作 时 ， 只 能 对 oz1 轴 、 ou 轴 或 op 轴 产 生 力 答 ,而 
不 能 对 og: 轴 、oz: 轴 产生 力 第 ， 但 对 ou、ov 轴 不 能 同时 有 四 : 
个 喷嘴 产生 力矩 的 情况 。 

当然 ， 不 同 的 飞行 器 其 喷嘴 的 个 数 和 在 星体 上 的 布置 情况 
都 是 不 相同 的 ，“ 阿 波 罗 ” 的 喷嘴 布置 比较 典型 ， 所 以 本 章 将 
以 “阿波 罗 ” 喷 嘴 控 制 系 统 为 例 ， 研 究 航 天 飞行 器 的 姿态 控制 
问题 。 

通过 前 几 章 的 介绍 ， 已 知 作为 误差 信号 ， 欧 拉 角 和 四 元 数 
完全 是 对 应 的 ， 因 此 ， 从 原则 上 讲 ， 凡 是 用 欧 拉 角 作为 误差 信 
号 的 控制 均 可 以 转换 为 四 元 数控 制 。 1 
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$2 ”姿态 控制 系统 误差 信号 的 组 成 
及 其 交 联 影响 
无 论 是 姿态 稳定 还 是 姿态 控制 ， 都 可 以 看 成 是 将 星体 坐标 
系 ozlgxz; 通过 控制 转换 到 需要 坐标 系 oz*y*z* 的 问题 。 敏 感 元 
件 敏感 体 坐标 系 对 需要 坐标 系 的 偏差 ， 根 据 控制 规律 组 成 控制 


指令 ， 启 动 执 行 元 件 产生 控制 力矩 ， 控制 飞行 器 以 减 小 偏差。 
其 结构 方块 图 如 图 4:3 所 示 。 





图 4.3 姿态 控制 结构 方块 图 


敏感 元 件 为 测 角 和 角速度 系统 ， 对 运载 火箭 来 讲 ， 往 往 是 
三 自由 度 陀螺 仪 和 速率 陀螺 仪 ， 对 航天 飞行 器 来 讲 ， 往 往 利 用 
”红外 地 平 仪 、 太 阳 敏 感 器 和 星 敏 感 器 。 

执行 元 件 是 根据 控制 信号 产生 力 和 给 以 改变 飞行 器 姿态 的 环 
节 ， 产 生 控 制 力矩 的 方法 有 两 大 类 。 

(1) 利用 环境 特征 所 产生 的 力矩 。 有 ， @ 引 力 栅 度 力 拭 ， 
名 地 磁力 给 ，@@ 气 动力 力 簿 四 太阳 光 压 力矩 。 

飞行 器 上 携带 的 力 给 产生 器 ， 如 ; 四 喷嘴 控制 系统 ， 回 飞 
轮 控制 系统 。 飞 轮 系统 是 通过 改变 飞轮 的 角 动量 矢量 来 吸收 飞 
行 器 多 余 的 角 动量 矢量 ， 从 而 通过 控制 星体 的 角 动 量 来 达到 控 
制 星体 姿态 的 目的 。 飞 轮 角 动量 相对 于 星体 的 变化 率 是 系统 的 
欠 力 第 , 它 和 上 述 的 其 他 力 挎 不 同 。 前 已 论述 , 环境 力 朱 很 小 ， 
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不 能 在 短 时 间 内 完成 较 大 的 姿态 变化 。 飞轮 控制 杂 绕 主要 用 于 
凑 态 稳定 与 定向 。 本 章 主 要 研究 喷嘴 控制 系统 。 数 态 挫 制 的 一 
个 重要 问题 是 如 何 组 成 控制 误差 信号 。 如 前 所 述 ， 可 以 科 用 责 
坐标 系 之 间 的 欧 拉 角 或 四 元 数 来 表示 两 坐标 系 之 间 的 误差 。 以 
下 分 别 进行 研究 。 


一 、 欧 拉 角 法 
回 到 第 三 章 §1 节 ， 如 图 4.4， 如 果 取 欧 拉 角 4p 、4% 、4y 作 : 








图 4.4 误差 角 示意 图 
为 误差 信号 。2。、Q，、82。, 为 相对 角速度 ， 则 


WA + (fzcosAp + QuysinAg)tgAy 
” =- Qasindp + Qycosdg 


4 人 cos40 i+ DysinAgp 


47= cosAy 





(4.1) 
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式 中 角速度 加: 、9，、9-, 是 由 于 喷嘴 启动， 作用 在 星体 上 . 
力 乱 而 确定 的 。 把 本 个 哎 路 所 产生 的 力 拓 作为 一 个 单位 ， 且 设 
是 体 绝 对 角速度 为 ov 、 Oo 、Osi， 则 


/ 
Dz = 2 ) or0s, + a 





一 Tz =) My, 
Oy, (全 O@zi@Ozl 十 Lo, (4.2) 
60- 二 


式 中 [Le jm. [C712, ~ Tz) /Ty lz 0 z、 [1;,— 
了 /Is,]waiwy, 为 惯性 交 联 项 ， 是 由 于 沿 三 个 惯 性 主轴 的 转动 
惯量 不 等 而 引起 的 。 可 以 看 出 ， 当 沿 某 一 轴 方 向 产生 力矩 肘 ， 
不 仅 引 起 该 轴 角 速度 变化 ， 而 且 引 起 其 他 两 轴 角 速度 的 变化 。 

如 果 不 用 惯性 主轴 0z,y,z, 作为 控制 加， 而 用 如 图 4.2 所 示 
的 0puv 作 为 控制 轴 。 令 





























dy 一 To ， Qa La 一 7 ， 4 一人 
(4.3) 
则 
站 (az 十 ao ) 
四 (4.4) 
go = 2(0,, Gy1) 
又 因为 
这 = 和 2 Cs - 入,) 
(4.57 
ao 一 2 = 2 Mt M,) 
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0 一 1 全 4， 十 也: 一 Ts yg, ) 
TylTz, TylTs, 
(4.6) . 


1{1y, — Tz Ty 十 7z， ) 
Vp 2 ylz, M, "Tle TT, PE 


可 以 看 出 ， 当 大 Ta 时 ， x 、 " 轴 产 生 相互 交 联 。 为 了 打破 
此 交 联 ， 采 用 如 下 方法 进行 控制 。 

如 图 4.5， 引 入 非 正 交 款 w、2” 
轴 ， 它 们 与 a 、?” 轴 之 间 的 夹 角 均 . 
为 > ， 则 


Qi’'—= QuC08V — avSiny 





-Toin 7") tm, ( 竺 - Lac0gy 


2T7y,1s, 2TyTz, 
Ty+Ts, + Tz ) ， 
2 7 -giny (4.7) 
为 了 打破 交 联 ， 需 使 
ly- Taicogy -也 十 7zsiny=0 
ga 基 1 31 
改 ”tey = (4.8) 
， + 十 7z， 本 本 
则 Gu' = Ms (cosy -2 biny ) (4.9) 
21y, 21 ylz 
同 理 
Go 一 — Gusiny + qvcosy 


> -- (Ty -Tz T+ Ts ) 
2 人 (各 5》 





yz Pi 区 1 


了 了 8 





I, + Is, _ I -1 ) 
二 cosy 2777 siny 

(4.10) 
将 (4.8) 式 代入 (4.10) 式 ， 可 得 ; 


av'= MM, (各) (4.11) 
于 Tz 27 I 


玖 当 1y, 关 Ti 时 ， 利用 非 正 交 系 opu'w 代替 opuv 来 控制 ， 可 以 
消除 由 于 转动 惯量 不 对 称 而 引起 的 交 联 。 因 


ed 和 -全 


故 - i y=arctg(f2) -所 (4.12) 


回 到 (4.2) 式 ， 式 中 交 联 项 与 其 他 两 项 相 比 ， 数 量 较 小 ， 
因此 可 近似 认为 











Oz 二 CQza 
Tl : 
MM 四 
Oy ~ =gy, (4.13) 
yi 
di Pr 


在 飞行 过 程 中 ,转动 惯量 变化 很 小 ， 而 喷嘴 产生 的 力 垂 为 常 
数 ， 故 可 以 认为 az,、ay,、a, 为 常数 ， 则 
=@riot Grt : 
oo ae (4.14) 
Ozi—= Orot Gzt 


改 喷嘴 控制 的 结果 ， 上 只 能 引起 星体 颖 对 角速度 的 变化 。 如 果 设 
需要 坐 株 系 oz*y*z* 对 惯性 化 标 系 旋转 角速度 为 0*， 则 . 
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DO Oitart | “ 

Dy=oy0- Oitant (4.15) 

so OL art 
1、0@%,、0@7 ,取决 于 瞬间 需要 姿态 的 变化 ， 认 为 是 已 知 的 ， 
通常 变化 比较 缓慢 。 由 (4.15) 式 可 以 看 出 ， 当 喷嘴 产生 控制 力 
矩 时 ， 引 起 星体 绝对 角速度 的 变化 ， 因 而 改变 了 体 坐 标 系 相对 
于 需要 坐标 系 的 相对 角速度 ， 来 消除 体 坐 标 系 对 需要 坐标 系 之 
间 的 误差 角 。 但 由 (4.1) 式 可 以 看 出 ， 某 一 轴 的 相对 角速度 变 
化 ,不仅 引起 相应 的 欧 拉 角 变化 ， 其 他 两 个 欧 拉 角 也 在 变 ， 这 
样 就 引起 交 联 。 交 联 的 结果 ， 影 响 了 误差 衰减 速度 。 已 经 证 明 
.用 欧 拉 角 作为 误差 信号 控制 是 稳定 的 ， 故 误差 最 终 会 衰减 为 
零 ， 完 成 定位 控制 。 

当 误 差 角 和 角速度 都 比较 小 时 ， 由 (4.1) 式 
49 Ds 
1 By (4.16) 
| Ay~ Ba 
则 交 联 解除 ， 三 通道 互相 独立 。 通常 利用 误差 相 平 面 来 产生 入 
制 暑 嘴 开 关 的 信号 ， 此 时 相 平 面 (42，49%) 产生 az: 信号， 
(4%，4%) 产生 ou 信号 ，(47，4y) 产生 wz 信号 。 关 于 相 平 

画 内 距 呢 开关 控制 规律 ， 下 一 节 将 详细 研究 。 


、 四 元 数 法 


各 果 设 将 体 吝 标 入 ou 转换 成 需要 标 系 05+ 的 四 
元 数 为 ”， 则 


多 二 1 Lan Lor -oa (4.17) 


式 中 下 标 “*?” 号 表示 在 oz*g*zx* 各 办 上 投影 ，. 
下 标 “1 ”号 表示 在 ozibiz: 各 轴 上 投影 。 
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写成 标量 形式 


ho 
‘ 
hi 
42 
4 
0 9 一 8 十 zy — OF+* Oy, — Qi# Oz 
_ lot*-@z,: 0 ;Ost TO OY ~ Oy 
2 OY — Oyry ~ WDE — Wz, 0 Oz 十 Oyi 
Oz2*— Oz 一 Or 十 Oh， 一 Or 一 Oo 0 
No | | 
A 
。 (4.18) 
12 
hs 
0 ; OtoOr; ~ OFT Oy -t+ 
I Oi!s — Wri 0 » -Oa + Oz yi — Wy 
2 Oyi — Oyis OE 一 Oo 人 》 ~ Oz1 + Oz 
#1 ~ Wz ~ OF 二 Oy, OE1 一 Oo 0 
ho 
hi " 
(4.19) 
hs 
hs 


如 果 取 和 四 、4。、4 作为 误差 信号 ， 即 相 平面 (1， 入 ) 产生 
4z,， 引 起 wai 的 变化 相 平 面 《4。， 知 ) 产生 ay,，3 引 起 wy, 的 
变化 ; 相 平 面 (0s，ja) 产生 gz,， 引 起 wz, 的 变化 。 由 (4.18) 
或 (4,19) 式 可 以 看 出 ， 当 @z, 变化 时 ， 不 仅 引起 ,的 变化 ， 同 


时 也 引起 和 4、 的 变化 ，@wy, 和 ws, 的 情况 相同 。 和 欧 拉 角 作为 


误差 信号 一 样 ， 产 生 了 交 联 。 已 经 证 明 利 用 四 元 数 分 量 作为 误 
差 信 号 ， 控 制 是 稳定 的 ， 故 最 后 可 达到 定位 状态 和 ==1， 思 = 
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A 二 a 二 0。 当 加 、4。、44 都 是 小 量 时 


| 
加 os - Qo) hos ~ wai) ho 


hooF -oho on) ho (4.20) 





hs LC ~ zi) ho 
则 交 联 解除 ， 三 通道 互相 独立 。 


$3 欧 拉 角 作 为 误差 信号 时 ， 喷 跑 
控制 规律 的 确定 
喷嘴 是 根据 姿态 控制 系统 输出 的 误差 信号 来 进行 工作 的 。 
通常 利用 误差 相 平 面 来 分 析 喷嘴 的 控制 规律 。 所 谓 误 差 相 平面 
即 是 ， 以 实际 运动 参量 对 理想 运动 参量 的 偏差 来 作为 相 平面 的 
横 坐 标 ， 以 召 表 之 。 如 果 是 以 欧 拉 角 作 为 误差 信号 ， 则 刀 代 表 
饼 仰 角 偏差 4p 、 偏 航 角 偏差 4y 和 滚动 角 偏差 4y， 而 用 偏差 的 
变化 率 作为 相 平面 的 纵 坐 标 ， 以 方 表 之 。 对 欧 拉 角 来 说 ， 则 访 
代表 4 多 、4 多 、4y》， 
设 以 性 表示 某 一 轴 的 控制 力矩 ，I 为 相对 于 该 轴 的 转动 惯 
量 。a 为 相应 角 加 速度 ， 互 为 垂直 于 此 轴 的 平面 内 的 误差 角 ， 
如 为 姿态 误差 角速度 ， 则 
dB _M 
oI 
由 于 飞行 器 在 飞行 过 程 中 ， 转 动 惯量 工 变化 很 小 ， 而 由 喷嘴 所 
产生 的 力 簿 可 为 常数 ， 压 可 近似 认为 4 为 常数 。 
由 (4.21) 式 


=a (4.21) 


Bb?— FB?2—2a(B ~ Eo) 、 (4.22) 
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如 果 a 二 0， 即 不 进行 控制 ， 则 
B=B, (4.23) 

则 相 轨 迹 为 相 平 面 上 一 条 直 

线 ， 如 图 4.6 所 示 。 

如 果 a 关 0， 即 进行 控制 ， 则 


E22-pE?2 
= 2 二 二 0 











(4.24) 图 4.6 相 轨 迹 示意 图 
为 相 平面 (已 ， 太 ) 上 的 抛物 线 。 

当 了 用 二 0,， a 之 0 时 ， 抛 物 线 自 下 而 上 ， 对 应 于 不 同 的 起 始 
条 件 (B。， 记 ,)， 有 一 族 自 下 而 上 的 抛物 线 充满 相 平面 。 

当 弄 <0，s<0 时 ， 抛 物 线 自 上 而 下 ， 对 应 于 不 同 的 起 始 
条 件 (。， 户 ,)， 有 一 族 自 上 而 下 的 抛物 线 充满 相 平面 。 

由 图 4.6 可 以 看 出 ， 无 论 力矩 政 取 何 值 ， 相 点 轨迹 的 特点 
是 仅 有 一 个 运动 方向 ， 其 沿 着 直线 和 抛物 线 的 轨迹 总 是 顺 时 针 
方向 。 、, 

现在 的 问题 是 在 姿态 控制 过 程 中 ， 我 们 期 望 得 到 什么 样 的 
相 轨 迹 。 为 了 保持 运动 稳定 ， 应 使 相 轨 迹 在 相 平面 上 形成 极限 
环 ， 亦 即 是 相 轨 迹 组 成 一 “封闭 曲线 ”， 而 一 切 在 此 封闭 曲线 
外 边 开始 的 相 点 ， 均 终止 在 此 “封闭 曲线 ”上 。 此 时 ， 随 着 时 
间 的 递增 ， 误 差 角 和 误差 角速度 总 是 约束 在 一 定 的 范围 之 内 。 

在 对 航天 飞行 器 进行 姿态 控制 时 ， 由 于 种 种 原因 ， 可 能 存 
在 干扰 力 年 ， 特 别 是 当 变 轨 发 动机 工作 时 ， 由 于 重心 偏 移 和 推 
力 偏 心 ， 会 产生 干扰 力矩 。 因 此 ， 要 分 两 种 情况 来 研究 喷嘴 控 
制 规 律 。 


一 、 干扰 力矩 为 零 时 ， 喷 嘴 控 制 规律 的 选择 
当 干 扰 力 矩 为 零 时 ， 所 期 望 的 罗 线 是 ， 由 误差 角 和 角速度 
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所 确定 的 相 轨 线 ， 形 成 稳定 极限 环 。 从 节省 燃料 的 观点 出 发 ， 
并 且 希 望 此 极限 环 包含 一 死 区 ， 在 此 区 域内 ;喷嘴 不 工作 。 根 
据 以 上 原则 ， 如 图 4,7 的 开关 曲线 ， 即 可 满足 要 求 ; 图 中 4BO PD 


- 局 H<c0 - 
四 人 “<0 











图 4.7 开关 曲线 图 
之 间 是 死 区 ,控制 开关 曲线 由 两 条 抛物 线 和 两 条 直线 组 成 ， 其 


方程 分 别 为 





AB: B=p*- b’ (4.25) 
2 lal 
Op: B=- p*+.B* (4.26) 
2 |al 
FD:; E=—- KB-b (4.27) 
HB: E=- KB+b . (4.28) 


则 此 四 条 线 将 相 平 面 分 成 三 部 分 。 几 相 点 落 在 48B、HHB 之 右 
的 ， 产 生 负 力矩 ， 落 在 CD、FD 之 左 的 ， 产 生 正 力矩 ， 落 在 
4B8、 及 B 或 CD、FD 之 间 的 关闭 发 动机 。 如 图 4.7 .所 示 ， 设 超 
始点 为 (Bo ， 记 。) ， 则 产生 负 力 氟 ， 相 点 举 PK 栅 物 线 运动 至 
用 点 与 了 8 直线 相遇 ， 立 即 关 闭 发 动机 ， 相 点 沼 直 线 履 妨 运 动 
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至 六 点 与 抛物 线 C7D 相 遇 ， 产 生 正 力矩 相 点 沿 抛物 线 CD 运 动 
至 D 与 直线 FD 相遇 ， 再 关闭 发 动 栅 ， 相 点 沿 直线 D4 运动 至 4 
与 抛物 线 4B 相 遇 ， 产 生 负 力矩 ， 相 点 澡 抛 物 线 4B 运 动 至 B 与 
直线 五 B 相遇 ， 关 闭 发 动机 ， 相 点 沿 BC 直线 运动 至 C 点 与 抛 
物 线 CD 相遇 ， 形 成 了 极限 环 4BCD4。 可 以 看 出 ， 抛 物 线 CD 
是 正 开 线 ， 抛 物 线 4 瑟 是 负 开 线 ， 直 线 了 和 互 妃 是 闲 线 。 甚 中 
五 为 斜率 ，0 为 截 矩 ， 都 是 待定 系数 。 和 研究 图 4.7 的 开关 曲 
线 ， 可 以 看 出 剩余 角速度 如 愈 小 ， 愈 有 利于 节 省 燃料 ， 故 选 
择 关 线 方程 为 

B= -FB-E* 

[gi pig (4.29) 


如 图 4.8 所 示 ， 将 直线 交点 移 至 横 轴 上 ， 并 引入 户 = 土 1， 








I ， 
<0,a<0 






M>0,0>0 


: ”图 4.8 改进 的 开关 曲线 图 

让 一 士 站 是 为 了 限制 误差 角速度 。 开 关 曲 线 将 相 平面 上 、 下 半 

平面 各 分 成 四 个 区 域 。 上 下 两 平平 面 是 完全 对 称 的 ， 可 利用 如 

图 4.9 的 结构 图 来 进行 控制 ， 则 可 形成 围 弹 ( 一 B*,0)，(B*,0) 
两 点 的 极限 环 。 

在 选择 喷嘴 控制 规律 开关 曲线 时 ， 有 两 个 性 能 指 慰 需 要 考 

伐 ， 即 相 虑 进入 极限 环 的 时 间 是 否 最 快 和 在 相 点 进入 极限 环 以 





7=sien|e - Sigenb.(P* ~ 二 | 
2 


六 









(¥) 


图 4.9 改进 的 开关 曲线 计算 流程 

及 在 以 后 正常 的 控制 中 ， 燃 料 是 否 最 省 。 这 两 个 指标 是 互相 对 
立 而 又 统一 的 。 上 面 所 选择 的 控制 规律 ， 就 是 时 间 和 燃料 消耗 
之 间 的 折 中 方案 。 但 由 于 闭 线 是 任意 选择 的 ， 故 不 是 最 优 折 中 
方案 。 下 面 利用 庞 特 里 亚 金 极 大 原理 来 研究 最 优 控 制 开关 曲 
线 。 

1. 时 间 最 优 的 喷嘴 控制 规律 

设 在 起 始 有 瞬间 召 二 万。 ， 户 = 户 , ， 所 谓 时 间 最 优 的 控制 规律 
即 是 选择 一 种 喷嘴 开关 曲线 ， 最 快 地 使 (Z。， 户 。)->(0，0). 

由 方程 (4.21) ， 如 果 以 zx 表示 控制 作用 量 ， 则 w 的 取信 为 
a 、0 ，- a。 将 方程 (4.21) 写 成 状态 方程 标准 形式 ， 则 

aB 


wt 


dap 
7 


(4.30) 
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起 始 条 件 ， t= 二 加 时 ， E=Eo, E=Eo 
终端 条 件 : t== 妇 时 ， 加 二 户 =0 - 
最 优 性 能 指标 1 


本 t= 1 -， (4， 31) 


这 是 终端 固定 ， 时 间 自 由 的 最 优 控制 问题 。 如 果 设 共 略 变量 为 
幼 、%z， 则 哈密 顿 函数 为 1 

百 三 名 记 十 gat (4.32) 
由 极 大 原理 知 最 优 控 制 的 必要 条 件 是 哈密 顿 国 数 最 大 ， 由 
(4.32) 式 知 最 优 控制 


a*= |al signya(t) (4.33) 
由 正则 方程 知 
-__ oF 
(Ph, ba) = jE, HI (4.34) 
即 
dp 
0 
发 (4.35) 
dt pi 
则 
pi=0O1 
(we 一 CO ， (4.36) 


故 $2(t) 是 t 的 线性 销 数 。 在 <i<< 妇 区 间 内 ，92(t) 的 符号 最 
多 只 能 变 号 一 次 ， 且 每 一 个 最 优 控制 的 取 值 都 是 jd 或- al ， 
并 在 “不 多 于 两 个 区 间 上 为 常数 ”的 逐 段 常 信函 数 。 

当 x= |a| 时 ， 
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入 一 族 抛物 线 ,， 如 图 4,10 所 示 。 





图 4.10 对 应 于 正 力矩 时 的 曲线 族 
当 w 二 ~- la] 时 ， 
E? 
alr 
为 一 族 扫 物 线 ， 如 图 4.11 所 示 。 


B= Ci， 





图 4.11 对 应 于 负 力 矩 时 的 曲线 族 . 
因为 每 一 个 最 优 控制 u* 是 逐 段 常 值 函数 ， 它 取 值 |a| 或 
-lol ， 并 且 取 常 值 函 数 区 间 不 多 于 两 个 。 考 虑 到 终 端 条 件 ， 
其 最 后 一 段 轨 线 必然 为 通过 原点 的 抛物 线 的 一 部 分 ， 则 可 能 有 
两 种 情况 。 

(1) 开始 时 ， 罗 , ==0s- Cit<0, 则 w= -lol , 相 点 沿 抛物 线 

应 >- D3 

a 


128 
运动 至 和 点， 到 := Cs- Citm 二 0， 控 制 变 号 ， 相 点 沿 


FE? 
E= 
2 1al (4.37) 
运动 至 o 点 。 如 图 4.12， 
Vy, 1 
(BB,, Bb) 
[a {1 
I 
| 
ul 1 
fo 上 -了 
0 t 





图 4.12 vs。>>0 时 轨 线 示意 图 


(2) 开始 时 ， 
WW,=0,- C0 
则 w= lal ， 相 点 沿 抛物 线 
FB2— gE?2 
一 | 


运动 至 点 ， 风 :一 Ca - Cis=0， 控制 变 号 ， 相 点 沿 抛物 线 





(4.38) 





图 4.13 .中 0 之 0 时 轨 线 示意 图 
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当 超 始 条 件 变化 时 ， 全 部 最 优 相 轨 线 如 图 4.14 所 示 ， 凡 起 


下 = a 








图 4.14 最 优 开关 曲线 


始 条 件 使 
WW,=0;~— Cto<0 
wo 二 ~ lal 
的 ， 均 沿 抛 物 线 
np _E:-B 
E=E'0 21al 


运动 ， 与 4o 相 交 ， 然 后 控制 变 号 ， 沿 4o 趋 于 原点 。 凡 是 起 始 
条 件 使 
”到 一 Co- Oto >0, w= lal 
的 ， 均 沿 抛 物 线 
B23 

B=-B ta 
运动 ， 与 Bo 相交 ， 然 后 控制 变 号 ， 沿 Bo 趋 于 原点 。 可 以 看 
出 ， 抛 物 线 Bo 和 4o 将 相 平面 分 为 两 部 分 ， 凡 是 相 点 藩 在 两 抛 
物 线 之 有 的 ， 产 生 负 力 算 进 行 控制 ， 凡 是 相 点 落 在 两 搬 物 线 之 
左 的 ， 产 生 正 力 秆 ， 当 相 点 与 抛物 线 Bo 或 4o 相交 时 ， 控 制 变 
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号 。 此 种 开关 曲线 ， 柯 以 保证 误差 训 减 最 快 ， 但 不 能 保证 燃烧 
消耗 最 小 ， 特 别 是 没有 设置 死 区 ， 当 误差 衰减 到 原点 时 ， 由 于 
控制 周期 是 有 限 的， 喷嘴 将 处 于 不 断 的 正 反 开启 状态 ， 是 非常 


不 利 的 。 


2。 考 嵌 燃料 消耗 和 误差 衰减 时 间 最 快 时 的 喷嘴 控制 规律 


如 果 在 考虑 误差 豪 减 最 快 的 同时 ， 还 考 虑 到 燃料 消耗 问 
题 ， 则 是 混合 性 能 指标 的 最 优 控 制 。 此 时 


t 了 
Tom= | (K+ ED 到 
io 


此 时 哈密 顿 函数 为 


(4.39) 


R=Vo( K+ U0|)+VEF+YVUV (4.40) 


应 用 极 大 原理 ， 罗 一 ~ 1， 则 


e=ViB+YU -kK- |0| (4.41) 
为 了 使 哈密 顿 函 数 & 为 极 大 ， 由 (4,41) 式 ， 应 使 


VU |I7| 一 >max 


则 最 优 控制 


(4.42) 


la| ” 当 罗 (之 1 时 
wu*(t) 一 0 当 | 罗 22)| 志 1 时 (4.43) 


己 类 共 元 方程 为 


(4.44) 








Vi=0! | 
| (4.45) 


到 一 CaO 
山 到 :( 全 只 可 能 变 号 一 次 。 
如 果 要 求 将 (如,, 户 , ) 一 > (0， 
0), 设 起 始 豚 时 多: 之 一 1, 如 图 4,15， 


lal 当 丈 (引文 1 时 


WV, 





图 4.15 多。 变化 图 
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乞 三 - |a| ， 则 相 点 将 沿 抛物 线 


户 2 - 方 3 


B=B, - 
2 lal 


(4.46) 





.运动 。 至 点 时 

W(tn) = ~1 
由 (4.43) 式 ， 此 时 uw 二 0， 则 相 点 将 沿 户 = 启 。 的 直线 运动 至 点 
与 抛物 线 4o 相交 ， 此 时 


. W(t,)=1 
-由 (4.43) 式 ， 此 时 w= lol ， 相 点 沿 抛物 线 
2 1al 
赵 于 (0,0) 点 ， 如 图 4.16 所 示 。 可 以 看 出 ， 由 于 考虑 到 燃料 消 


V1 








E2 


2 lal | 





图 4.16 ,考虑 燃料 消耗 的 最 优 开 关 曲 线 
耗 ， 引 入 了 死 区 。 现 在 的 问题 是 。 当 起 始 条 件 变 化 时 ， 丈 点 应 
.该 沿 什么 曲线 变化 ， 即 闭 线 的 方程 是 什么 。 
已 知 在 如 点 和 ?2 点 满足 
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OCs- Oitmn=—1 . ， 
4.47 
{coer ( ) 
tf = 2 
故 ts bm 5 (4.48) 


另 一 方面 ， 由 极 大 原理 知 ， 对 固定 端点 自由 时 间 ， 沿 最 优 轨 
线 ， 哈密 顿 孙 数 &@(t) 二 0。 当 % 二 0 时 ， 由 (4.41) 式 


CBE- KEK=0 (4.49) 
_EK 
0 一 证 (4.50) 
_1 2 
故 tn-tn= — KE" (4.51) 
因 B, =, 
Lp Bb? 
B=BEnt (t,tn) Dn= eT 
， . 
故 Bn= (+ 和 2] (4.52) 
同 理 ， 如 果 起 始 瞬 间 到 ?>1，x= [dl ， 则 
(128a， 
Bnt = (sir+ 站 2)8 (4.53) 


故 对 于 混合 指标 ， 将 《。， 户 ,) 控制 至 原 点 (0，0) 的 喷嘴 
控制 开关 曲线 由 四 条 拢 物 线 组 成 。 如 图 4.16 所 示 。 


pb? 
Ao: 瑟 一 一 (4.54) 
2 lal 
FE? 
Bo: 于 二- 二 . 
0 B= ~ al (4.55) 


A'o: p=(s +t) (4.56) 
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B'os =- (z+ 人 4) 4.57) 


这 里 为 与 误差 衰减 时 间 相 联系 的 常数 。K 愈 大 ，4'o 愈 接 
近 4o， 即 综合 性 能 指标 ， 偏 重 于 衰减 时 间 ， 反 之 , KK 傅 小 ， 
4'0 愈 接近 于 横 坐 标 轴 ， 表 示 偏 重 于 燃料 消耗 。 可 以 看 出 ， 利 
用 此 种 开关 坦 线 控制 ， 当 误差 衰减 到 零 时 ， 喷 嘴 仍 会 处 于 不 断 
开关 状态 ， 是 不 利 的 。 

3。 有 死 区 时 ， 混 含 指标 最 优 喷 嘴 控 制 规律 

在 上 一 段 研究 混合 指标 最 优 控制 时 虽然 其 中 一 段 当 
过 :| <1 时 , uw 二 0， 但 当 误 差 角 赵 于 零 时 ， 此 段 亦 渐 趋 于 
零 ， 所 形成 的 极限 环 只 取决 于 控制 周期 的 大 小 ， 喷 嘴 基 本 上 处 
于 “ 正 ”，“0 ”，“ 负 ” 交 赵 状态 。 在 长 时 期 的 姿态 控制 过 
程 中 ， 哮 嘴 由 于 不 断 的 开关 ， 可 能 会 损 托 ， 且 达 不 到 池 省 燃料 
的 目的 。 实 际 上 ， 并 不 要 求 将 误差 角 控制 到 零 ， 允 许 有 剩余 误 
差 18*| 。 为 此 可 根据 |B*| 建立 一 死 区 , 而 将 四 条 抛物 线 分 开 ， 
如 图 4.17 所 示 , 将 Bo、4'o 移 至 BD、4'D; 将 Ao、B'o 移 至 





图 4.17 有 死 区 的 开关 曲线 示意 图 


AC、B'Q， 此 时 开关 曲线 方程 如 下 
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E? 
BD:; EF=E*- (4.58) 
2 {al 
{1 2» 
'D: B=E* ( )B? .59) 
4 十 21a| + 至 (4.59) 
记 2 “ _ 
AOC: Hh=-B*+- | (4.60) 
2 |al 
1 | 2s 
BC'， p=-B*- (sr) . 
了 可 十 去 (4.61) 


则 此 四 条 开关 曲线 ， 将 相 平 面 分 成 三 部 分 。 凡 相 点 曲线 落 入 
五 D、4 沁 曲线 之 右 的 ,产生 负 力 矩 ; 凡 相 点 落 在 BC、4C 曲 线 之 
左 的 ,产生 正 力 邱 ; 凡 相 点 落 在 四 条 握 物 线 之 间 的 , 关闭 发 动机 。 
例如 ， 设 起 始 条 件 (B0, 育 ,) 使 到 < -1， 则 相 点 褒 
D2 ~ pe 
2 [al 
运动 至 与 4'D 曲线 相遇 ， 此 时 到 := - 1，% 二 0， 相 点 语 直 线 运 
动 至 与 4C 曲 线 相 遇 ， 此 时 到 ?>=1，x= lol ; 相 点 沿 40 曲 线 至 
C 点 ， 由 于 控制 周期 影响 ， 形 成 极限 环 ， 如 图 4.17 所 示 。 极 限 
环 的 宽度 取决 于 剩余 角速度 的 大 小 。 
为 了 保证 能 以 最 少 喷嘴 (一 个 喷嘴 ) 形成 极限 环 ， 在 四 条 . 
抛物 线 的 基础 上 ， 增 加 两 条 抛物 线 ， 如 图 4.18 所 示 。 
在 BD 和 A4C 之 内 增加 两 条 抛物 线 ， 有 即 
BE 
2 1al 


B=B,-— 





B"D: B=B1- (4.62) 


用 nx Es 

A"C:; EE= B12 

且 将 两 抛物 线 之 间 的 区 域 用 平行 于 吾 轴 的 直线 分 开 为 两 个 区 . 
域 ， 即 区 域 2 和 区 域 3 。 则 此 6 条 喷嘴 控制 开关 曲线 将 相 平 面 . 


(4.63) 





135 








图 4.18 “阿波 罗 ” 开 关 曲 线 终 


上 半 平 面 分 为 五 个 区 域 ， 下 半 平面 相对 应 的 也 是 五 个 区 域 ， 基 
工作 状态 如 下 表 所 示 。 




















区 城 喷 嘴 工 作 状 起 
1 | 中 中 起 动 ， 力 顷 为 负 《 正 》 ， 至 相 上 进入 到 指向 质 物 线 止 。 
2 kz) 中 中 起 动 ， 力 姑 为 负 《 正 》， 吾 误差 除 为 等 上 。 四 
3 (3 | 一 人 克昌 工作 。 
i》 | 机 清关 间 ， 但 在 下 过 情况 除外 ， 当 虹 关 已 经 动 了 ， 人 点 在 区 
间 (- 如， 瓦 +) 过 滤 到 已 办。 
5 《5') | 与 区 域 1(1') 相 似 。 








根据 以 上 所 述 ， 可 得 计算 结构 方块 图 如 下 ， 
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lSignE 0? 


7=Sign|# +Sign(B) ‘(E+ + 





判别 (4, 5') 


区 


JSignh>0? 









(1) 


图 中 





(4.64) 


二 , 干扰 力矩 不 为 零 时 ， 喷 嘴 控 制 规 律 的 选择 

当 于 殷 力 矩 不 为 零 时 ， 飞 行 器 姿态 误 益 在 相 平 面 上 的 相 
所 ， 总 是 在 以 下 三 个 力矩 之 一 所 确定 的 抛物 线 的 一 段 上 。 这 三 
个 力矩 是 ， 


. 137. 
(1) 干扰 力矩 与 喷嘴 正 力矩 之 和 (as + |al )3 
《2) 干扰 力矩 与 喷嘴 负 力 矩 之 和 (or - lal ); 
(3) 只 有 干扰 力矩 o+. 四 

设 喷嘴 控制 开关 曲线 采用 四 条 撼 物 线 ， 如 图 4.17 所 示 。 研 究 在 _ 





图 4.20 有 干扰 时 的 轨 线 变化 情况 示意 


干扰 力矩 作用 下 的 喷嘴 开关 曲线 的 选择 。 

设 起 始 有 瞬间 ， 相 点 在 第 一 象限 ， 则 在 x= - la| 的 作用 下 ， 
相 点 沿 or - [al 所 确定 的 抛物 线 与 开关 曲线 0'D 相 交 于 m。 如 
图 4.20 所 示 ， 然 后 喷嘴 关闭 ， 相 点 沿 由 干扰 加 速度 ar 所 确定 
的 抛物 线 运 动 。 

车 as>0， 有 两 种 可 能 ， | 

(1) laz| 较 大 ， 相 点 不 与 抛物 线 4B 相交 ， 而 交 抛 物 线 CD 
十 m1。 然 后 沿 or - lal 所 确定 的 抛物 线 运 动 。 最 后 将 弹 D 点 运 
动 ， 不 能 形成 极限 环 。 

(2) iaz| 较 小 ， 相 点 与 抛物 线 4B 交 于 tr。， 然 后 沿 ar 十 
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lal 所 确定 的 抛物 线 运动 ， 则 可 形成 绕 B 、D 两 点 的 极限 环 。 
车 as<0， 则 与 抛物 线 4B 交 于 ms， 然 后 沿 一 lar| + la| 所 
确定 的 抛物 线 运动 ， 是 否 能 形成 极 限 环 ， 取 决 于 与 抛物 线 4/ 了 
相交 后 的 情况 。 
起 始点 沙 在 第 三 象限 的 情形 ， 与 上 上 面 叙述 相似 ， 可 参看 图 
4.20. 
可 以 看 出 ， 如 果 起 始 条 件 (B。， 育 0) 合 Ws—=O0s- Co -1, 
则 当 a 之 0 时 ， 只 有 在 由 az 所 确定 的 抛物 线 
B*— BE2 


B=Bnt 
” 21ea| 


与 48 曲线 相交 时 才 会 形成 极限 环 。 
同 理 ， 如 果 起 始 条 件 (B80, 户 0) 使 一 Ca - Cito>1， 则 当 
ar<0 时 ， 只 有 在 由 os 所 确定 的 抛物 线 


BE?—E2 
2 2lerl 


多 


与 CD 曲线 相交 时 才 会 形成 极限 环 。 

为 了 能 形成 极限 环 ， 应 选择 有 干扰 加 速度 时 的 开关 曲线 ， 
使 在 死 区 内 ， 由 干扰 加 速度 ez 记 确 定 的 抛物线 , 恰恰 与 另 
一 边 的 开关 曲线 相 切 ， 以 下 对 正 负 于 拢 加 速度 分 别 进 行 研 
究 。 

(1) gS0. 

当 和 干扰 加 妹 度 为 正 财 ， 所 要 求 的 开关 曲线 如 图 4,21 历 示 ，. 
为 了 使 由 干扰 加 速度 es 所 确定 的 抛物 线 
_B?_ 

2 laz| 


在 B 点 与 48 曲线 相 切 ,移动 了 CD 曲线 的 截 距 ， 关 键 在 于 求 


E=~-D,+ 


739 





图 4.21 a 之 0 时 的 开关 曲线 


截 距 D。. 
研究 D(B*, Bx) 点， 此 点 在 C'D、D'DID 和 DBD' 三 个 抛 
物 线 上 ， 故 





(4.65) 





消去 妈 *、 三 *， 则 得 ， 





ps=D1- (it+D[ 若 +- 二] 
min 


(4.66》 - 
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式 中 Di 为 扫 物 线 D'DYD 与 也 轴 交 点 ， 而 D1 为 抛物 线 D'D1D 与 
召 轴 交点 。 因 





B*—D,- 2 
1 2|a| 
BE*=D* Bx*? 4.67) 
~ 20Clal -Tasl) 
消去 B*、 记 :， 则 得 : 
2 2 四 
D* := Dia + D2za2 (4.68) 


a—a2 
(2) ar<0. 
当 干 扰 加 速度 为 负 时 ， 所 要 求 的 开关 曲线 如 图 4.22 所 示 。 















4 
， B(E*, Ex*) 

pF=-D4+— tt 

” 2( lal 一 le 于 UN Dp 

) 1 

« Eh 
-D: 分 
， BM\E=D, 名 他 





2 J’ 机 
六 Ca 
了 入、 
1 人 


图 4.22 a 过 0 时 的 开关 曲线 
为 了 使 由 干扰 加 速度 as 所 确定 的 抛物 线 
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在 DD 点 与 CD 曲线 相 切 ， 移 动 了 4'B 曲线 的 截 距 ， 关 键 在 于 求 
截 距 疡 ， 

研究 BCB*, 户 *) 点 ， 此 点 在 4'B、BD3B' 和 BDB' 三 个 抛物 
线 上 。 


, E? 
尖 一 - 一 -一 由 
| Ds 2admin 
Bx? 
本 一 站 :一 本 4.69 
| 1! 2larl (4.69) 
BD 二 
?2(lal.~ lasl) 


消去 B* .。. 记 :， 则 得 : 





D,=D;- (Di+D9)| 吉 +(1- laa| }! ]m 
in 


(4;70) 
而 Ds — Dor+ Dag 
C2 一 02 
由 以 上 叙述 可 知 ， 干扰 加 速度 的 符号 不 同 ， 则 改变 不 同 的 
开关 曲线 的 截 距 来 满足 相 切 条 件 。 由 于 在 整个 飞行 过 程 中 , 干 
扰 加 速度 是 变化 的 ， 因 此 ， 根 据 (4.66) 和 (4。70) 式 所 确定 的 
Ds、D4, 也 是 变化 的 。 这 样 就 使 开关 曲线 变 得 复 杂 化 了 。 但 
考虑 到 干扰 加 速度 所 确定 的 抛物 线 与 开关 曲线 相 切 的 条 件 ， 并 
不 是 绝对 必要 的 。 我 们 感 兴趣 的 是 能 保证 有 一 适当 的 极限 环 。 
为 此 ， 对 干扰 力矩 作用 下 的 开关 曲线 选择 如 下 。 
以 “阿波 罗 ” 为 例 ， 首 先 选 择 一 参考 角 加 速度 smin(amin 一 
1.4 度 / 秒 *) ， 则 可 以 有 五 种 情况 。 
(1) Gazamin . 
如 图 4.23; 选择 D1=D, -Ds=- 咏 = ~2D,， Ds= 


(4.71) 
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-0.75D， 则 形成 极限 环 ， 如 图 4,23 上 的 虚线 所 示 。 





图 4.23 Qt >ami a 时 开关 曲线 


《2) dmin>as>0 .50Umin 
如 图 4.24 所 示 ， 选 择 





图 4.24 amin 记 4 之 0,5amis 时 开关 曲线 
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D,=D i 
一 D, 一 — D;= 一 D 
Ds3=0.5D 


则 形成 的 极限 环 如 图 4.24 上 虚线 所 示 。 
(3) 0.5amin >as> — 0,5amin 
如 图 4.25 所 示 ， 选 择 
D1=Ds=D 
-一刀 一 -了 =- 站 











图 4.25 0.5amias>>oz 一 0.5enia 时 开关 曲线 


则 形成 极限 环 如 图 4.25 上 虚线 所 示 。 
(4) -0.50min>ar> — qmin 
如 图 4.26 所 示 ， 选 择 
Di=Ds=D 


-Ds=-D 
-Di=s-0.5D 
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唱 形 成 极限 环 如 图 4.26 上 虚线 所 示 。 





图 4.26 一 0.5amin Qt 之 一 Qami a 上 时 开关 曲线 
(5) -amin>as 
如 图 4.27 所 示 ， 选 择 











图 4.27 一 amtn 之 as 时 开关 曲线 
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D1=Ds=2D 
-D,=-D 
-D,=0.75D 
则 形成 极限 环 如 图 4.27 上 虚线 所 示 。 
以 上 五 种 情况 ， 可 以 用 以 下 计算 方块 图 表示 。 


i -人 2 -Dor 





图 4.28 存在 a 时 开关 曲线 计算 流程 图 
式 中 
(1) 当 @ 字 amin 上 时 ， Di=D, -DD;= -DD= -2D, Ds;= 


一 0.75D,， Go 一 Cin， qe = ar. 


(2) 当 anmin>as 之 0.54min 时 ，Di=D:=D==D,，D,= 


0.5D, de=Qmin, Ce 一 和 or， 


和 
(3) 当 0,.5gmin >d#> -0.5amia 肝 ， Di=Ds=D,=D;,= 


了 346 
D, do=ae=anin., 
(4) 当 -0.54min>as> ~ Gmin 时 ， Di=D;=D;,=D, 


Ds:=0.5D, qo = as, Ce 一 min。 


(5) 当 ~ Qmin 之 QF 时 ， Di=D,=2D, D;,=D, ~ D;= 


0.75D,， ao 一 起 on， Ce 一 Cmin 。 


$4 四 元 数 作为 误差 信号 时 ， 哮 踢 
控制 规律 的 确定 
.以 上 研究 了 欧 拉 角 作为 误差 信号 时 ， 喷 路 的 开关 控制 规 
律 。 在 用 欧 拉 角 作 误差 信号 时 ; 利用 了 近似 关系 起 (4.21)， 如 
果 用 四 元 数 分 量 作为 误差 信号 ， 则 需 利 用 四 元 数 方程 


和 一 (4.72) 
式 中 不 为 供 坐 标 系 oz19121 与 需要 坐标 系 00*y*a* 之 间 的 四 元 数 ， 
而 号 为 相对 角速度 

Q=0- ax (4.73) 
如 时 设 需要 坐标 系 旋转 角速度 @* 为 常 值 失 量 ， 则 

= = (4.74) 
这 里 a 为 角 加 速度 。 
微分 (4.72) 式 ， 得 


2-1( a+ 人 2) (4.75) 
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即 人 2 的 
和 = 人 -和 oj- 

| 0 0 2 2 2 2 3 
和 


(M4.76) 





， 2 


= CT 
2 4 \2' 2 


当 喷 嘴 不 工作 时 ， Qn =Ay—= z=0 


2 ， 2 
和 针 + 全 竺 = 各。 + 全 和 Cn (i=1, 2, 3) 





(4.77) 
这 表示 在 (4:， 和 4:) 相 平 面 内 的 一 个 椭圆 ， 其 中 心 在 原点 (0， 


0)， 半 长 轴 为 也 ~DOi， 半 短 轴 为 VOT. 
如 果 @z, = 二 =a， ob 一 bz 一 0， 且 近似 认为 4 与 人 无 关 ， 峙 
一 4 十 who(21 一 0) -号 (4 — 446) 





(4.78) 
即 
二 和 -hh + + = (4.79) 
在 相 平面 (2 ，42) 上 ， 亦 为 精 国 ， 其 中 心 在 Ea 0) ,于 长 


轴 为 2 人- ， 半 短 辅 为 4 
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同 理 ， 如 果 gqy, 二 a， az 一 0z: 一 0， 则 


2 2 
二 人 (和 





如 果 a:, =a， az 一 0 一 0， 则 


和 十 2-(?， - 222) 一 4 





4 0 


(4.80) 


(4.81) 


将 以 上 结果 与 (4.23) 和 (4.24) 式 比较 可 以 看 出 ， 当 喷嘴 不 工 
作 时 ， 用 欧 拉 角 作 为 误差 信号 ， 在 相 平 面 (B， 方 ) 上 ， 相 点 
钞 直 线 运动 ;而 用 四 元 数 分 量 作为 误差 信号 ， 在 相 平面 (24， 


和 上， 相 点 沿 中 心 在 原点 的 狭长 椭圆 运动 。 


当 喷 哗 工 作 时 (认为 三 通道 独立 ) ， 用 欧 拉 角 作为 误差 信 

号 ， 在 相 平面 (BF， 户 ) 上 ， 相 点 沿 抛物 线 运动 ， 而 用 四 元 数 

分 量 作为 误差 信号 ， 在 相 平面 (4 夭 ) 上 ， 相 点 沿 中心 在 
(2a%0o/ 8，0) 的 椭圆 运动 。 当 a>>0 时 ， 此 椭圆 中 心 右 移 ， 


4<0 时 ， 椭 圆 中 心 左 移 ， 如 图 4.29 所 示 。 





-图 4.29 ”用 四 元 数 夫 示 的 相 轨 访 


下 面 以 〈2s，4s) 相 平面 为 例 ， 来 研究 最 优 控制 规律 。 此 
时 ， 状 态 方程 为 


这 里 控制 变量 的 取 值 范围 为 w= - lal ，0，|al 
共 思 方 程 为 


dp 02? 
网 出 


Ca _ 
a — pi 


即 | yp1(é) = 人 4sin( 2 十 B) 


2 
yat) 一 Acos( 2 +B] 


这 里 任意 常数 4 、 刀 由 共 罗 变 量 起 始 条 件 来 确定 。- 





2 
| io + 


B=arcte( 2 ) 





QQ Y20 
如 果 选 择 性 能 指标 为 
” 也 ， ， 
Ton=| (K+U| )at 
利用 庞 特 里 亚 金 极 小 原理 ， 则 哈密 顿 函 数 为 - 
可 一 及 二 四 | 二 入 各 -全 轴 加 二 昂 和 es 


则 最 优 控制 
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(4.82) 


(4.83) 


(4.84) 


(4.85) 


"(4.86) 


(4.87) 


‘50 
sy No 
一 lal 当 台 2 之 1 时 


U#*=1 0 当 3 I 时 (4.88) 








40 

Dp 
. pe 

la] ” 当 i 1 时 


由 (4.84) 式 知 2(t) 为 余 弘 函数 ， 必需 研究 在 控制 过 二 程 中 会 发 
生 儿 次 变 号 。 由 (4.88) 式 可 知 ， 当 


Mp ，， 
2 2 一 士 I 


时 ,UY* 变 号 ， 即 


p20 1 leos | 2 本 =E1 





2 


i 


20 


(4.89) 


例 设 人 =2.8943 x10-?rad/s，% 二 0.997912128，yi0= 
2.8x10-3, $20=2.5, 





则 当 329s 一 1 时 ， 加 一 六 一 2.004184481 
五 一 三 (0.884105155 - 0。658644345)s 王 155 .7964344s 
当 3 一 -1 时， 名 一 一 2.004184481 


已 = 广 (2， 257487499 -0 。658644345)S 二 1104， 821998s 
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其 周期 为 “5- 一 4341 .765065 


由 上 例 可 以 看 出 ， 由 于 周期 较 长 ， 往 往 只 出 现 (- ,0, +) 
或 ( 十 , 0, 一 ) 的 控制 情况 。 


设 起 始 瞬 间 %zo> 区 ， 由 (4.88) 式 ， 此 时 坟 二 一 al ， 邵 
图 4.30 所 示 ， 相 点 (4s， hs) 将 沿 由 方程 


43+ al hhat 43=0 
(hao hs0) . 











4 lal 入 + 全 43=0 
图 4.30 ”用 四 元 数 表示 的 最 优 开关 曲线 


和 二 lal hohs 二 + 和 





=480+ lal ojao + S28 (4.90) 
所 确定 的 轨 线 运动 至 r(hsam，h 和 am) 点， 此 时 gen 一 世 ， 转 为 
u* 二 0, 而 tr 点 的 和 sm， 和 sm 由 下 式 确定 。 


2 2 
am |a| dohan+ = #0+ lal 和 ha 十 到 4 和 


2 
kk 十 PimAam 一 号 yonjan= 0 


# 


(4.91) 
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以 后 相 点 沿 好 二 0 轨 线 移动 至 nC(%，，%,) 点 ， 其 方程 为 


ht (4.92) 


， 2n = - 郊 ， 下 二 lol ， 此 时 4so， 和 由 下 式 确定 。 


2 
和 3 al hohen+t = 
(4.93) 


2 
五 十 D1n han 一 号 -assn0 


由 (4.92) 式 和 (4.93) 第 一 式 


1 (5 .2 








- 1 
_ 人 2 _ 人 2 人 2 2712 
和 | 和] 
(4.94) 
由 (4.91) 式 第 二 式 和 (4.93) 式 第 二 式 
1 OQ? 
pn=(K 一 号 njanj 
(4.95) 
a — 下- 全 oo) 
如 图 4.30 所 示 ， 此 时 ， om 一 胸 ， on 二 一 苑 ， 故 
1 or 
pin=7-(K py xn 
Di (4.96) 
1 
Pin pn ( + 区 an 
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因 
$n = ~ EV = 一 - SVR- TI 3m = 人 1m 
. (4.97) 
-0 Yi - 2 
故 (E 7 (Kt) (4.98) 


将 (4.94) 式 代入 上 式 ， 则 得 Bo 的 曲线 方程 ， 它 是 喷 嘴 闭 线 。 
( 病 ?"-F) 各 + 全 49m 
4 


24o Aa2h3 
1 
. 2 0Q2 上 
(in+ 纪 aio) 
人 2 2 《22 2 [I 
Tala a 四 (3 二 jj 上 Kham 
同 理 ， 对 于 好 'o 曲 线 ， 此 时 名 = - 2120， pz =2/40o， 则 
+ 
bin=# (K+ 3%) (4.100) 
= 全 
罗 、 加 = 于-( 天 - 5 4,) (4.101) 
2 {ro 
(K+ 六 1) =(F Er (4.102) 
2° #2 人 2 -2 
( 世 tnt EK) sn 


(4 


-本 和 sa( 和 8 十 所 - 2 4 im )5- Khsm 


一 0 (4。103) 
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则 开关 曲线 由 Co、0'o、Bo、B'o 四 条 曲线 组 成 。 因 为 K 是 
对 间 因素 ， 下 傅 小 ，0o 曲 线 愈 人 靠近 横 轴 o43。 由 图 4.30 可 以 看 
出 , 无论 在 任何 起 始 条 件 下 ， 由 此 开关 曲线 所 确定 的 控制 角 加 
速度 ， 最 多 只 变 号 一 次 ， 即 可 趋 于 零点 。 但 当 误 差 很 小 时 ， 在 
零点 附近 ， 由 于 控制 周期 、 误 差 或 干扰 原因 ， 喷 嘴 可 能 会 出 现 
连续 开关 状态 ， 这 是 很 不 利 的 。 实 际 上 ， 并 不 要 求 将 2s、4s 都 
控制 到 零 , 可 以 容许 存在 小 的 剩余 误差 。 为 此 引入 死 区 D1D;， 
将 四 条 开关 曲线 分 开 如 图 4.31 所 示 。 


A 






NU 





lal A( N10, 430) 








图 4.31 考虑 死 区 时 的 开关 曲线 
图 中 4 为 允许 误差 ， 四 条 开关 曲线 的 方程 如 下 : 


2 2 
CD ， 好 二 Jal 加 二 车 和 一 |al 和 4+ 生 


(4.104) 
2 
4 
(4.105) 


2 
OD;: -和 -加 hh 二 二 入 = lal 4+ 


BD: Gn x){( 和 + 全 如 


2 1 Qs 0 二 
4 [x( 和 二 4 全 ) 4 Tlal a 
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+ 结 | 二 1 ( 2 27 ,2 4-_2° 4 | 
2%0l lal ho 43+ 4 )+ 4lal Xo | 
+ KA%s=0 四 (4.106) 


B'D,; (过 2+ x){( 48 1222 ) 


1 
2 1 (fj;2:, Qo. 2? 二 上 
[a( + 各 )+4- Tial m4 


4 
Q? 0? 

-六 [本 元 全 大 也 3 )+4- Za 太 4 | 
— Kh,=0 (4.107) 

可 以 看 出 ， 开 关 曲 线 BD 和 B'D, 为 高 阶 曲 线 ， 在 飞行 器 上 不 易 

现 。 为 此 需 进 一 步 简 化 。 
如 果 令 
X= 加 二 全 + ja] 2o4， 

(4.108) 


人 2 


A2 
4lal ho 


1 4=4- 
则 BD: 可 写成 
2 (at | 
-la hd -| 
=f(%s, X) (4.109) 
这 是 超越 方程 。 由 于 X 的 表达 式 中 号 -48 项 很 小 ， 则 可 用 逐次 


到 近 法 解 超越 方程 。 
一 次 近似 ， 可 令 











-1 二 43+ |a| 和 0 (4.110) 


x) | 
2 一 aa (5 全 A2 + 地 1 十 pi 





则 





01221 2 2 十 | 2 
| | 如 a 4 +laodo| 
= (4 ， 玉 1) (4.111) 
二 次 近似 ， 可 令 
开 : 一 和 十 到 和 8 二 lal ho41 
则 43s=f (4s 四 2) 


如 此 反复 选 代 ， 直 至 14- hs;| 志 e 时 止 。 

这 样 确定 BD1 曲 线 ， 计 算 很 复杂 ,不 便于 在 飞行 器 上 应 
用 ,实际 上 ， 作 为 控制 开关 曲线 ， 并 不 要 求 准确 地 按 (4.106) 
式 来 进行 控制 。 为 了 易于 实现 ， 可 对 控制 开关 曲线 进行 简化 ， 
例如 用 一 次 近似 方程 (4.110) 代 趟 (4.109) 式 。 此 时 


人 2 2 人 2 
BD ， 2 _2% Pa (5 枉 开 + 4 二 有) 和 








”0 2 上 
和 全 元 (和 3 十 lal jo40?] 

(4.112) 

| 

B'Ds: hs= -2K - Caan ! 芒 £)’ | 


| 和 -7 or 1 2 


(4.113) 
利用 (4.112) 和 (4.113) 式 作为 开关 曲线 有 以 下 缺点 。 
(1) 必须 保证 
2 


Tn tlaldod4)>0 (4.114) 
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(2) 此 曲线 不 经 过 D1 和 Ds 点 。 


例 设 人 =2.8943 x10-3rad/s， 10o 一 0.997912128 ， 
le| =0.01rad/s:?, 4=0,017453293rad 
对 (4.113) 式 计算 结果 


当 五 =1 时 ，4=0.01318，2;= -0.017451905 
js 王 0.0076075，23=0 


五 二 0.1 时 人 s 王 0.00572，?23 一 -0.001746072 
4=0.00211095，%s= 二 0 


太一 0.01 时 和 二 0.003，4%s 二 0,017423196 
4s=0.00066; %s= -0.000000024 . 


不 二 0.001 时 4 和 s==0.001678，% 和 4 二 -0.017457361 
4s=0.0002084795，%s 二 0 


五 三 0 时 4 二 0.0001,， 4 二 ~-0.017459854 
可 以 看 出 ， 由 于 (4.114) 式 的 限制 ，%s 不 能 为 零 。 了 





缺点 ， 进 一 步 简 化 , 略 去 (4.112) 和 (4. 113) 式 中 的 了 让 I 于 (和 3 十 
lal AoAdi), 则 
BDi: 4a 一 一 1 4 十 4 (4.115) 
lal %0 
B'D,: hs= -1 A423-4 (4.116) 


为 两 条 抛物 线 ， 与 无 关 。 如 果 利 用 (4.115) 和 (4,116) 式 
作为 关 线 ， 已 不 能 满足 性 能 指标 (4.86) 式 ， 故 是 次 最 优 的 ， 此 
了 时 ， 奔 路 控制 开关 曲线 各 图 4 32 所 示 。 其 计算 结构 图 如 图 4.33 
所 示 。 
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图 4.33 “开关 曲线 计算 流程 图 
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利用 以 土 计算 结构 图 ， 应 保证 ， 
2 2 |al 各 
和 3 < (ei 十 4 ) 


此 点 是 不 难 满足 的 ， 如 用 前 例 数据 ， 则 要 求 

|4s| <3.447878375rad/s 
以 上 研究 的 结果 都 是 对 于 干扰 力矩 为 零 的 情况 。 如 果 存 在 干扰 
力矩 ， 则 可 以 参照 上 一 节 的 结果 ， 类 似 地 得 出 在 干扰 力矩 不 为 
零 的 情况 下 的 喷嘴 控制 开关 曲线 。. 


8 5 四 元 数 作为 误差 信号 时 ， 喷 踢 
控制 的 最 佳 控 制 轴 法 


上 一 节 在 三 通道 互相 独立 假设 下 ， 导 出 了 相 平 面 (%i, 和 1) 
上 的 喷嘴 开关 曲线 。 由 本 章 第 二 闻 论述 了 在 大 姿态 情况 下 ， 
三 通道 实际 上 是 交 联 的 。 由 于 交 联 的 影响 ， 将 影响 姿态 误差 的 
衰减 过 程 ， 甚 至 会 影响 到 控制 的 稳定 性 ， 为 了 加 速 误 差 收敛 过 
程 ， 必 须 设法 消除 或 减少 交 联 影响 。 但 由 刚体 动力 学 的 景 优 控 
制 问题 的 研究 可 以 看 出 ， 用 外 力矩 作为 控制 函数 ， 由 于 附加 了 
刚体 动力 学 方程 ， 使 方程 组 变 为 非 线 性 变 系 数 微分 方程 组 ， 不 
能 得 出 解析 形式 的 最 优 控制 表达 式 ， 需要 进行 大 量 的 数值 计 
算 ， 给 实 规 最 佳 控制 带 来 很 大 的 困难 。 

考虑 到 航天 飞行 器 往往 采用 如 图 4.1 和 4.2 所 示 的 喷嘴 系统 
来 产生 控制 力矩 ， 如 果 近 似 认 为 








= (4.117) 
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为 常数 。 则 动力 学 最 优 控 制 与 运动 学 最 优 控制 一 致 。 第 三 章 第 
六 节 已 经 证 明 可 选择 . 
Qi;= — KiNdoh: (4.118) . 

作为 姿态 控制 信息 。 如 果 需 要 坐标 系 oz*y*z* 的 绝对 角速度 为 
QO* 二 (@z，@y，0@2;)， 则 应 使 

1 一 和 zi 一 Wt 二 一 KNohi 

[a -Oy 二 一 Kho%2 | (3.119) 
Qs =0z— Ot, = ~ KNoh, 


而 体 坐 标 系 绝对 角速度 @ 二 (wz,，@wy,，wzi) 由 作用 在 飞行 器 上 
的 控制 力矩 来 确定 ， 则 

Waart t+ Wrio 

ee 


0Oazi 一 4zi 十 四 zi0 


这 就 是 说 ， 在 姿态 控制 过 程 中 ， 要 求 飞行 器 在 空间 的 旋转 角 速 
度 @ 的 方向 在 由 四 元 数 1 所 确定 的 欧 拉 轴 和 @* 的 合成 方向 上 。 

以 “阿波 罗 ” 喷 嘴 系 统 为 例 来 研究 喷嘴 系统 的 最 佳 控制 。 
参看 图 4.2， 可 以 看 出 启动 喷嘴 的 个 数 ， 可 能 有 三 种 情况 ， 即 
4 个 喷嘴 工作 ，2 个 喷嘴 工作 和 1 个 喷嘴 工作 。 由 于 每 一 个 时 
嘴 工 作 时 所 产生 的 推力 都 是 相等 的 ， 分 别 用 an 、ar、assav、 
qs 表示 两 个 喷嘴 工作 时 沿 各 相应 轴 所 产生 的 角 加 速度 ， 则 可 列 
表 如 下 天 。 可 以 看 出 ， 对 于 oz; 轴 可 以 产生 7 种 角 加 速度 ， 击 
对 于 oy1、0z1、04、02 轴 则 只 能 产生 5 种 角 加 速度 ， 故 无 论 是 采用 
oz1、09¥1、0%1 轴 还 是 采用 op、ou、ob 轴 都 只 能 产生 7 x5x5 一 175 个 
方向 。 

把 由 于 某 一 种 控制 而 产生 的 飞行 器 在 空间 转动 的 总 角速度 
方向 称 为 控制 轴 。 对 z1、y1、z 轴 来 说 ， 有 175 个 方向 ， 即 是 有 
175 个 控制 轴 ， 也 即 是 只 能 实现 175 个 方向 的 控制 ， 故 所 能 实现 

































































一 有 一 
Te 4 2 1 0 1 2 | 4 
方向 ss 
oX1 轴 (op 轴 ) 2Gzl | Gzl EL 0 -和 去 as -az, |~2az, 
oy1 轴 2ay, |oy,|/ 0 | 了 -ay，i 一 2 
oz1 勿 20z， az， p# 0 / ~az) 一 20z， 
0U 轴 / ay EL 0 -du| -aw - 
ov 轴 / av or 0 |- 二 Gy 一 G2 7 
的 控制 方向 是 有 限 的 。 


如 果 以 az 表示 在 ov1 轴 方向 的 控制 角 加 速度 ， 则 1 二 十 2， 
士 1， 土 立 ， 0; may;、Nazi 分 别 表示 在 ojj 、ozi 轴 方 向 的 控制 


角 加 速度 ， 则 m,n 二 土 2， 土 1，0. 在 天 瞬间 的 控制 轴 如 图 
4.34 所 示 。 用 召 控 z、 轧 控 /、 加 控 : 分 别 表示 控制 轴 B 控 在 体 坐 标 
系 ox191z1 上 的 三 个 分 量 ， 则 


Ha 


A =p ar dl may te, 
nq:, At.) 






4.34 控制 轴 五 控 示 意图 
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如 控 y 二 yiy 工 may Atx=pr 


[ee + laz Atr=ag 
B 控 :=@: 1 + Raz A = yx 


如 果 用 加 ( 召 :， 帮 ,, 如 ,) 表示 需要 轴 的 方向 ， 则 


B= 一 KNoAi + ow, . 
By= ~ Kehohst os, (4.120) 
. :2 KsAohst or, 





则 所 谓 “最 佳 控 秋 铀 法” 训 是 “在 每 一 瞬间 都 能 用 最 接近 于 和 需 
要 轴 召 的 控制 轴 吾 近来 进行 控制 ” 的 方法 。 
如 果 设 两 轴 间 的 夹 角 为 4 ， 则 
zB 控 z + 刀 ,B 控 y 十 日 接 。 
“084 a 
寻找 最 佳 控制 得 ， 即 是 在 所 有 控制 轴 中 找 最 大 的 cos4， 由 于 
控制 轴 数 量 较 大 ， 计 算 起 来 是 很 复 杂 的 ， 需 要 进一步 进行 简 
化 。 . “ 
在 体 坐 标 系 OY12121 中 ， 作 需 要 轴 (EB,, E,, B;), 过 点 
(BE:, B,, Za) 作 垂直 于 召 轴 的 平面 9 ， 如 图 4.35 所 示 ， 然 后 





(4.121) 








人 


图 4.35 需要 轴 刀 与 其 委 直 平面 9 未 章 图 
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找 出 所 有 控制 轴 为 控 与 平面 8 的 交点 〈 也 可 能 有 若干 控制 轴 与 
0 无 交点 ) ， 则 这 些 交 点 中 与 (Hs，;，) 点 距离 最 短 的 即 
是 最 佳 控制 轴 。 因 国 轴 在 体 坐 标 系 内 的 方程 为 


Br (4.122) 

则 过 ( 轧 ， 加 ,， 如 。) 点 与 此 直线 相 秋 家 的 平面 方程 为 
Baxit Boy Bev, ~ (BS+ BS+E2)=0 

故 在 到 瞬 间 过 ( 思 ，,， 思 ,) 点 稚 直 于 妇 辅 的 平 而 的 方程 为 
Bortin tt Byryir -Bagzig — [BI2=0 (4.123) 

而 在 K 瞬 间 控制 轴 在 体 坐 标 系 内 的 方程 为 


Vik _ Yir Z1k 














一 (4.124) 
设 控 制 轴 与 平面 久 在 瞬间 的 交点 次 (44， 统 ，z%)， 则 
wl 
Ban Bs fe + Ba 
好 二 一 一 Bl 5 (4.125) 
ep st erp 
Ek 








Bent +B, + Bs 
pr 


在 K 豚 闻 与 (Bzr, B yhy Bre) 点 的 距离 


p=(2% -Bor)? + (yi ~ By)* t+ (2 Be)? 
(4,126) 
故 求 minpzx 即 是 求 
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Bee Br Box yr 
CO NC 2 


{minlwi ~ Br|= min 
Berr+ Bys 名 + By ee 











Byr pr b yh Or 
2 y 一 一 ®t, 
B#(1- Boy Bs ) Ba 人 (1 Bsr , Pe ) 
Bur + Bp Bople 





minly} ~ B,r|=min 











Br Pr 
. p44(1- 玫 二 3(1- 2 妈 ) 
min|z» -BE.x|=min k Yk k Yk 











Bane 十 万 Ce tpB,, 
DE pe 




















(4.127) 
可 以 看 出 ， 如 果 a 、p 、? 是 连续 变化 的 量 ， 则 取 
Bp_ Op Bon_ op Bye_ Bs 
天 一 有 
即 得 最 小 值 。 但 a 、6 、y 均 为 离散 的 量 ， 故 取 
min 至- 六 3 min 2 - 入 iD| 二 上 2 -他 
(4.128) 
”如 果 利 用 (4,128) 式 求 最 佳 控制 轴 ， 则 需要 运算 
7x5+7x5+5x5=95 次 
计算 量 仍 很 大 ，, 仍 需 进 一 步 简 化 。 取 
minj 召 ez -ct min|B,s— Pels min| 召 oz 一 3 
即 min|( ~ Kihorhis + tp) — on 
min|( — Kohor hzr + Os) -pal (4,129) 


min|( — Kshoshas + win,) — ya) 


我 们 把 按 (4.129) 式 控制 的 方法 ， 称 为 “最 佳 控 制 轴 法 ”。 如 
果 给 出 ! 、m、 的 各 种 可 能 值 ， 则 利用 “最 佳 控 制 轴 法 ” 控 
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制 时 ， 可 由 下 式 给 出 1 、m、% 的 选择 公式 


当 — KNorAhir Og 


“20z1 A 





Orr = 4z>> 忆 qz 时 
3 3 . 
rl 当 F n> hs 时 ‘ 
> 3 1 
| zr 当 和 Tn 4 时 
Ja = 1 _1 
Gz 一 0 当 了 4m 这 4: 之 4! 时 
(4.130) 


| 一 CQza 当 一 an>4:> 一 Taz, 时 


一 Gzi 当 一 en>4:> 一 Sar, 时 





、 一 24z， 当 一 了 qa:>Az 时 


如 果 将 以 上 关系 绘制 在 相 平 面 (- 严 oho2，oz 一 @%,) 上 ， 则 
得 出 在 “最 佳 控 制 轴 法 ”控制 下 的 开关 曲线 如 图 4,36 所 示 。 





图 4.36 景 佳 控 制 轴 法 的 开关 曲线 : 
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间 理 可 得 
一 下 4 和 
20y, 当 2hon oe Out =4, 之 防 ay 时 
Gy 当地 ow 全 49 时 
一 | 3 .3 
MQy 一 0 当地 0m 这 4 之 了 本 oa 时 
， 3 3 
Gy 当 一 了 I 之 4 之 一 2 1 时 
3 - 
一 2cy 当 - 本 9o 人 4 时 
(4.131) 
24:, 当 一 ha ott 一 Ozig 一 4 之 3g, 时 
qe 当 了 0 之 4 之 qz, 时 
i 了 3 3 
3Qzi 一 1 0 当 林 42 一 4z 六 一 A 时 
1 3 阅 
— Gz1 当 -- 4 az>>4: 字 一 Das, 时 
| 。 
一 202 当 - 4 = 时” 


(4.132) 


其 在 相 平面 上 的 开关 二线 如 图 427 所 下 
以 上 我 们 导出 了 最 佳 控制 轴 法 的 相 平面 开关 曲线 。 研 究 设 限 情 
襄 ， 由 (4.129) 式 知 ， 此 时 


了 367 


Or, — OF 
(or — 1) 









n=0 及 一 了 天 二 了 
(m=0) (m=1) (m=2) 
一 二 2000。 
一 二 30021) 





图 4.37 最 佳 控制 轴 法 的 开关 曲线 


1 = 一 oox 一 一 五 1 人 021 
人 一 on -OF = — Kshohs (4.133) 
4 一 oO — WO, — KsA0hN, 


如 果 令 Ki= Ks 一 Ks=E 


则 
4 
和 ax 
hl 
1 . ， 、 . 
0 ;» K Noh , Khohia, “KhoNg ps 
1|- Khoh, 0 3 Khha, ~ KAoAdoll A 
21— KAoN2, - K Mohs, 0 ， KAoNi| | be 
一 Khohs, KAoNs, ~— EK Noh 0 hal 





(4.134) 
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即 
= 和 Kh(1- 4 
| 和 二 -Kh 
2 


(4.135) 
= 一 二 Kh 和 





知 二 一 地 和 hh 


设 当 t= 如 时 ，ho(t0) 二 hoo， Ai(to) = hi10, halto)= N20, hs(?o) 
一 加 30 则 





1 
23 一 
(人 e+1 
00 
- 1— ho 1+ hoo 
= ( 寻 庆 (生计 ) 
1 + ho \1 ~ hoo (4.136) 


一 40V[1 十 入 
一 V( 中 2») 
2 2 1 二 ho/ \1— Noo 

1~— ho 1+ Noo 
2 aa ( 生 划 (入 对 ) 
= ha0 1+ hof \1 — hoo 


由 (4.135) 或 (4.136) 式 可 以 看 出 ， 在 极限 情况 下 ， 处 于 交 联 解 
耦 状态 。 当 上 二 递增 时 ，2o1， 而 人:、22、2s 均 趋 于 零 ， 此 时 
误差 衰减 最 快 。 但 由 于 所 能 实现 的 控制 轴 方 向 是 有 限 的 ， 达 不 
到 极限 情况 ， 只 能 使 控制 最 接近 极限 状态 ， 故 最 佳 控制 轴 法 是 
次 优 的 。 

最 后 来 研究 一 下 ， 利 用 “最 佳 控制 轴 法 ”在 相 平面 上 能 人 否 
形成 极限 环 。 以 (加 ， 晶 1) 为 例 ， 如 图 4.36， 由 直线 
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Os, + At= - Kihoh 和 Os, - -At= — KNoh 
所 确定 的 区 域 为 死 区 。 当 相 点 接近 死 区 时 ，?: 较 小 ， 由 (4.133) 
和 (4.135) 式 ， 可 近似 认为 
pm = 地 9 
旭 为 = 地 a 
43- A =ar (hi — hi0) 
3- Di = -好 先 [ — Kidoh+ KiAoNio] 
(4.137) 
改 在 相 平面 (- 天 1102 51) 内 为 一 抛物 线 。 如 图 4.38 所 示 ， 





图 4.38 轨 线 示意 图 - 


可 以 形成 极限 环 ， 但 死 区 与 控制 步 长 有 关 。 步 长 4 很 小 时 ， 死 

区 也 很 小 ， 喷 嘴 基 本 上 处 于 连续 开关 状态 。 这 是 很 不 利 的 ， 为 

此 将 控制 分 为 粗 控 区 和 精 控 区 。 当 
(Var a> 


3 (4.138) 
NM AFA TTAB: >e 


170 
时 ,为 粗 控 区 , 利用 最 佳 控制 轴 法 控制 ， 而 当 *<6, ier< < 时 ， 


则 采用 上 池 导 出 的 开关 曲线 控制 。 如 图 4.39. 











图 4.39 粗 、 精 控 开 关 曲 线 示意 图 


$6 航天 飞行 器 儿 种 典型 的 变态 
控制 举例 
以 上 我 们 叙述 了 利用 四 元 数 作为 误差 信号 的 喷嘴 控制 规 
律 ， 这 一 节 通 过 几 种 典型 的 姿态 控制 问题 ， 进 一 步 说 明 姿 态 控 
制 误 差 信 号 的 取得 和 计算 方法 。 


一 、 无 动力 飞行 时 ， 卫 星 的 姿态 控制 

无 动力 飞行 是 指 卫 星 上 变 轨 发 动机 不 工作 ， 卫 性 沿 惯性 实 
贺 轨 道 运 动 的 情况 。 此 时 的 姿态 控制 问题 ， 实 际 上 即 是 定 卫星 
上 某 一 轴 的 指向 。 我 们 把 卫星 某 一 轴 所 应 指 的 方向 ， 称 为 需要 
方向 。 如 果 取 地 心 惯性 坐标 系 作为 参考 系 ， 则 需要 方向 与 地 心 
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惯性 坐标 系 的 关系 只 有 两 种 情况 。 即 需要 坐标 系 对 惯性 坐标 系 
固定 和 需要 方向 对 惯性 坐标 系 变化 两 种 。 以 下 分 别 来 进行 研 
(1) 需要 方向 对 惯性 坐标 系 固定 时 的 姿态 控制 
设 地 心 人 惯性 坐标 系 为 ozogozo， 需 要 方向 oz* 对 惯性 坐标 系 
关系 由 Po, ao 两 个 角 来 确定 ， 如 图 4.40. 








图 4.40 需要 方向 对 惯性 坐标 系 关系 示意 图 


设 卫 星 入 胃 后 ， 其 体 坐 标 系 为 or1y1z1， 其 绝对 旋转 角速度 
为 @@， 它 在 体 坐标 系 各 轴 上 的 投影 为 os,、@y,、ws,， 如 果 姿 
态 控制 要 求 使 ow: 轴 指向 需要 方向 oz* ， 则 其 四 元 数 误差 信号 求 
法 如 下 。 | 

设 将 体 坐 标 系 转 为 惯性 坐标 系 的 四 元 数 为 9 ， 转 为 需要 坐 
标 系 的 四 元 数 为 4， 而 将 惯性 坐标 系 转 为 需要 举 标 系 的 四 元 数 





a 
OY Oroyo%0 


M 
bd Bo,ao 


1 


图 4.41 . 坐标 系 关系 示意 





OLYyYS 
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为 对。 如 图 4.41 所 示 ， 则 




















A4=gxM (4.139) 
而 = og (4.140) 
M cos& -sin 如 /cos 2、 
0 2 ， 0 ， Sn 0 | 2 
M ， cosb?, bo 
1 0 2 0 sn 7 0 
| 
M, sinb', 0 cosb', 0 | 0 
2 2 
MM; 0 ， -sinb', 0 ， cosB®/ sin? 
cosbricos™ 
2 2 
sinP'sin 9o 
2 -2 
一 (4.141) 
sin Brcos 
2 2 
cosb' sin ae 
2 2 


.利用 加 、%。、%: 作 为 误差 信号 ， 即 可 进行 姿态 控制 。 

(2) 需要 方向 对 地 心 惯性 坐标 系 变化 时 的 姿态 控制 

大 多 数 卫 星 姿态 控制 的 需要 方向 ， 对 地 心 惯 性 坐标 系 都 是 
变化 的 。 变 化 特性 随 着 卫星 姿态 控制 的 任务 不 同 而 不 同 。 以 地 
球 物 理学 卫星 为 例 ， 要 求 星 体 ow: 轴 指向 地 心 。 设 该 卫星 的 轨道 
根 数 为 a、e 、i 、 人 0、o 、 了 ,如 图 4.42 所 示 。 如 果 卫 星 在 对 
点 ， 过 点 作 轨 道 坐 标 系 人 zyyxzx。AMYyx 轴 为 以 到 地 心 05 联 
线 的 延长 线 。 向 外 为 正 ， 则 需要 方向 在 大 yx 轴 的 反方 向 上 。 
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图 4.42 需要 方向 对 地 心 惯 性 坐标 系 关系 示意 图 : 
Mu 在 轨道 平面 内 飞行 速度 的 反方 向 上 ，Mzw 垂直 于 轨道 
面 ， 形 成 右手 坐标 系 ， 则 需要 方向 ( -Uyw) 与 地 心 惯 性 坐标 
系 关 系 可 由 但、i 、w 、9 来 确定 .如 图 4.43。 设 体 坐 标 系 转 





图 4.43 需要 坐标 系 的 确定 
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为 惯性 坐标 系 的 四 元 数 为 9 ， 转 为 需要 坐标 的 四 元 数 为 4， 而 
将 惯性 坐标 系 转 为 需要 坐标 的 四 元 数 为 用 ,参看 图 4.41， 则 


4=gxM . (4.142) 


而 9 一 Onxg (4.143) 
二 


3 


a .77 t pol ofte 2 基 ， 关 其 
0008020 一 >O00 3 220 一 > 0 yy Zu > OMYuyZu—— ON Yo 

















歼 
M, cos 2 /2 0 0 -~ sin /2 
Mi|. | 0 cog /2 -sin Q/2 0 
M, 0 sin 1 /2 cos 2/2 0 
M, sin (2/2 0 0 Cos (2/2 
cosi/2 ~ sini/2 “0 0 
sini/2 cosi/2 " 0 | 0 
0 0 cosi/2  — sin2/2 
0 0 Sini/2 cosi /2 
cose 人 ， 0 ， 0  ， -sn 号 > 
w+0 . @+0 I 
0 » 2 Sg 0 0 | 
0 ,snoet0, cos2 十 9， 0 0 
2 2 
sin2+0, 0 ， 0 , cos2 士 2 交 












































_ cos 到 os 了 cos +0 + sin 2 cog sin 十 
2 2 2 
| 一 cog ?2 cos isin +0. sin Qoos ¢ coso+ 0 
2 2 2 2 
| _ cos sin toosl tO sn Qsin isinot® 
2 2 2 2 
| cos 2 sin Lsin +0 + sin Qain tooset 0 
V2 
2 | 
| — sin ~ sin co82 t+ os sin Ssin 45 
_ sin 2 sin 2 sin +0. cos Ysin Cos 二 
| 一 sin cog tcog +0 _ cos 2 cos i sin +0 
2 2 2 2 2 
.2 2 . @+ 人 0 0 @+0 
| -sin*cos tL sin ”costcos ;ogo+t 0 
\、 2 2 2 2 2 2 
| (4.144) 


由 于 假设 飞行 器 在 有 心力 场 作用 下 ， 沿 椭圆 轨道 运动 ， 故 
轨道 坐标 系 相对 于 惯性 坐标 系 的 旋转 角速度 沿 型 zx 方 向 ， 垂 
直 于 轨道 面 。 设 其 为 0w 二 oxxs， 如 果 按 以 下 次 序 求 四 元 数 

| i 


2 
0X08g0250 一 一 >0X1 扩 ZI 一 > ONY NSU—— OLY 2 
| OO 
| 





Ou 


党 


b= pO -DOP | (4.145) 


了 76 


N=(- 妆 2， 0， ov (4.146) 


则 A=pxN (4.147) 
亦 可 求 出 四 元 数 1 . 


二 、 卫 星 拦截 卫星 时 的 姿态 控制 


如 图 4.44， 设 目标 卫星 的 轨道 根 数 为 Qu、 eu, tus Qn, 
@x、Tx。 拦 截 卫 星 的 轨道 根 数 为 4、e、;?、 人 人 、w、7T。 拦截 起 
始 瞬 间 ， 目 标 卫星 在 鳌 点 ， 到 地 心 距离 为 rw 拦截 卫星 在 4 
点 ， 到 地 心 距离 为 Pr4， 速 度 矢 量 为 p4。 如 果 给 定 抄 堆 时间， 
则 在 了 瞬间 ， 目 标 卫星 运 动 至 吾 点 ， 到 地 心 距离 为 Ps。 因 而 ， 





图 4.44 卫星 拦截 卫星 示意 图 
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拦截 问题 即 是 自 4 点 控制 拦截 卫星 ， 使 其 在 T 瞬间 内 在 B 点 与 
目标 卫星 相遇 。 因 为 在 给 定时 间 工 通过 空间 两 定点 4 和 B 的 椭 
圆 轨 道 是 唯一 的 ， 其 在 4 点 的 速度 矢量 为 








一 志 A9 
4 一 Fm( :和 Pa 全) 
44 一 AT Dr x + pr Fr te >) (4.148) 
式 中 40=arccos( Tas ) 
lral lr sl 

sin 2:40 

J Vrallrsl 2 
BB-ecosg coos 人 . (4.149) 

` B= [ral + |ral 





2cos2 vv/ | 4| lrs| 


了 4 为 引力 常数 。 
9 为 4，B 两 点 偏 近 点 角 之 差 之 半 ， 可 利用 如 下 公式 求 
出 。 因 为 沿 椭圆 轨道 由 4 运动 至 B 的 时 间 





t -~ 
Ty) = BU osgt® 
1 + LB8(D - cosg(t)] [2g(#) — sin2g(®)] | 
2sinsg(t) 
| (4.150) 
式 中 A(t) =2[ra(é) ra(t)] loos 4 (4.151) 


因 给 定 的 拦截 时 间 为 中 ， 则 令 Tx = 二 7T， 解 超越 方程 (4.150)， 
即 可 求 出 9 。 通常 利用 如 下 的 迭代 方法 。 


选择 初 值 g。 = 全 (4.152) 
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OT (t) 
0g 


式 中 TY#( 共 一 全 -人 4 (4 为 计算 步 长 ) 


加 T(t) — T*(E) 
| | (4.153) 


OT¥ _Tu(t)[1+5cos’g(t) ~ 6B(t)cosy(t)] 
09 2B(i)sing(t) -~ sin2g(t) 





A LY) +2B(sing()] 一 
- vf Msing(t) VB(t) -cos gt) 





(4.154) 
选 代 直至 | 了 x (人 - 2 (| 过 el 时 为 止 ， 算出 g =g，. 
将 9 二 gs, 代入 (4.148) 式 ， 算 出 744, 此 速度 称 为 4 点 的 “ 需 
要 速度 ”。 令 


了 4 一 人 4 一 人 (4.155) 
则 Z4 为 变 轨 发 动机 推力 需要 方向 。 如 果 变 轨 发 动机 固定 在 星体 
上 ， 其 推力 方向 与 ox1 轴 一 致 ， 则 姿态 控制 的 任务 在 于 将 ox; 轴 
控制 到 74 的 方向 ， 设 74 与 地 心 惯 性 坐标 系 0xoyozo 的 关系 由 
24、24 确 定 ， 如 图 4.45， 





图 4.45 需要 速度 增 量 14 与 惯性 坐标 系 关系 


La 


| 
(4.156) 
Cos a =- 
sing 4a = 
"4 (4.157) 
cosp ,一 V74z 十 74z 


La 


设 地 心 惯 性 坐标 系 与 需要 坐标 系 oz*g*z* 之 间 的 四 元 数 为 ， 
则 | 


p=(cos cos 史 4 ，-- sin 4 sin ?4, 
2 2 2 2 





pa PA 2 PA ) 
S 0 TA Sin 志和 
ir cogs2 ， COS 3 3 (4.158) 


设 体 坐标 系 转 至 惯性 坐标 系 的 四 元 数 为 a ， 转 至 需要 坐标 系 的 
四 元 数 为 4 ， 则 
1 一 gr 了 (4.159) 


4=301"9 (4.160) 


当 |4@| = |2arcsin( 3 +43)| <s 时 ， 表 示 owi 轴 已 指向 14 方 

癌 ， 局 动 变 轨 发 动机 ， 产 生 推 力 ， 控 制 拦 截 卫星 的 质心 运动 。 

由 于 变 轨 发 动机 推力 是 有 限 的 ， 设 控制 步 长 为 44， 至 某 瞬 间 
1 -Fl < 


计 ， 关 闭 变 轨 发 动机 ， 其 控制 结构 图 如 图 4.46 所 示 。 
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国 诉 毕 鲜 内 入 开 刍 守 福 企 、97'y 国 


i135 19P| igS 14| 


. 辕 肝 关于 阳 于 区 


畦 著 头 萎 障 弹 玫 | 


徐 蛙 交替 腥 于 *Y 


[3] 
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